
Christian Frese 

Planung kooperativer Fahrmanöver 
für kognitive Automobile 



Scientific 
Publishing 



Gopyrighted maierial 



Christian Frese 

Planung kooperativer Fahrmandver für kognitive Automobile 



wui^yiighteci material 



Karlsruher Schriften zur Anthropomatik 
Band 10 

Herausgeber: Prof. Dr.-Ing. Jürgen Beyerer 

Lehrstuhl für Interaktive Echtzeltsysteme 
Karlsruher Institut für Technologie 

Fraunhofer-Institut für Optronik, Systemtechnik und 
Bildauswertung lOSB Karlsruhe 



Eine Übersicht Ober alle bisher in dieser Schriftenreihe erschienenen Bände 
finden Sie am Ende des Buchs. 



wüi^yiighted material 



Planung kooperativer Fahrmanöver 
für kognitive Automobile 



von 

Christian Frese 



Publishing 



wu^yiighted material 



Dissertation, Karlsruher Institut für Technologie 
Fakultät für Informatik, 201 1 



Impressum 

Karlsruher Institut für Technologie (KIT) 

KIT Scientific Publishing 

Straße am (^orum 2 
D-76131 Karlsruhe 
www.ksp.kit.edu 

KIT - Universität des Landes Baden-Württemberg und nationales 
Forschungszentrum in der Helmholtz-Gemeinschaft 



Diese Veröffentlichung ist im Internet unter folgender Creative Commons-Ltzenz 
publiziert: httpi/creativecommons.org/licenses/by-nc-nd/3.0/de/ 

KIT Scientific Publishing 2012 
Print on Demand 

ISSN: 1863-6489 

ISBN: 978-3-86644-798-1 




wui^yiighted material 



iighted material 



iighted material 



Planung kooperativer Fahrmanöver 
für kognitive Automobile 



zur Eriangung des akademischen Grades eines 

Doktors der Ingenieurwissenschaften 

von der Fakultät für Informatik 
des Karlsruher IrwIflutB HQr Technologie (KIT) 



genehmigte 

Dissertation 

von 

Christian Frese 

aus Aschaffenburg 



Tag der nriündlichen Prüfung; 



11. Juli 2011 



Erster Gutachter: 



Prof. Dr.-Ing. Jürgen Beyerer 



Zweitsr Gutachtsr: 



Prof. Dr.-Ing. Hsinz Wöm 



Oüpy iiyhico inaiotial 



Oüpy iiyhico inaiotial 



I 



Danksagung 

Die vorliegende Disseriaiion eiUsland wahrend meiner Tätigkeit als vvissenschafl- 
lichcr Mitarbeiter am Lehrstuhl für Inicrakiive Hcht/eiis} steme der Universität 
Karlsruhe (TU), die inzwischen m das Karlsruher Institut tür Technologie über- 
gegangen ist Dem Lehrstuhlinhaber Prof. Dr.-lng. J. Beyerer danke ich für sein 
Vertrauen in mdne Arbeit und ftir die Betreuung der Dissertation durch zahlreiche 
Diskttssionsbeiträge und Anregungen. 

Für die Übernahme des Korreferats danke ich Herrn Prof. Dr.-lng. H. Wörn \om 
Institut für Pro/essrcchentechnik, Automation und Robotik. Fbenso möchte ich 
allen Professtirinnen und Professoren danken, die wertvolle Hinweise /u meiner 
Arbeil gegeben haben oder an der Pi uluiig der Dissertatiim beteiligt waren. 

Diese Arbeit entstand im Rahmen des Sonderforschungsbereichs/Transregio 28 
„Kognitive Automobile" der Deutschen Forschungsgemeinschaft. Allen Mitarbei- 
tern des Projekts danke ich für die gute Zusammenarbeit. An erster Stelle sind hier 
natürlich Thomas Bat/ und die übrigen Mitarbeiter des Teilprojekts B3 „Verteilte 
Kooperation" zu nennen. Auch allen Studenten, die das Teilprojekt als studen- 
tische Hilfskräfte oder im Rahmen ihrer Seminar-, Studien- und Diplomiubeiten 
unterstützt haben, möchte ich an dieser Stelle danken. 

Die Simulation der untersuchten Verfahren wäre ohne die l'nterstützung der Pro- 
jektpartner aus dem SFB/Transregio nicht möglich gewesen. Insbesondere Stefan 
Vacek. Robert Naiiel, Frank Moosmanii. Julius Zieuler und Matthias CJoebl danke 
ich für die Bereitstellung von Software-Komponenten. Die Teilnahme an der Ur- 
ban Challense mit dem Team AnnieWAY war eine wichtige Erfahruns, für die ich 
allen Teammitgliedern dankbar bin. Schließlich bedanke ich mich bei den Mitglie- 
dern der Arbeitsgruppe „Wissensrepräsentation" für zahlreiche Diskussionen. 

Den Kollegen am Lehrstuhl für Interaktive Fchtzeitsysteme danke ich für vie- 
le m'oße und kleine Hilfestellungen und vor allem für die freundschaftliche At- 
mosphäre während und nach der Arbeitszeit. Stellvertretend für alle Mitarbeite- 
rinnen und Mitarbeiter des Lehrstuhls möchte ich hier diejenigen namentlich er- 
wähnen, die jahrelang den gemeinsamen Arbeitsalllag im Laborgebäude geprägt 
liaben: Jonathan Balzer, Andrey Belkin, loana Ghefa, Martin Grafmüllcr. Ciahy 
Gross, Michael Heizmann, Sebastian Höfer, Marco Huber, Michael Mai, Masoud 
Roschani, Jennifer Sander und Stefan Werling. Marco Hub«' gilt außerdem mein 
Dank für das Korrekturlesen des größten Teils dieser Arbeit. 

Meinen FItern, Großeltern und Verwantlten tlanke ich für ihre hnanzielle und mo- 
ralische Unterstützung während des Studiums und der Promotion. 

Karlsruhe, im Dezember 20 11 Christian Frese 



Oüpy tiyhioo inatotial 



Oüpy iiyhico inaiotial 



m 



Zusammenfassung 

Die Entwicklung der Fahrerassistenzsysteme ist in den letzten Jahren rasch voran- 
geschritten. Inzwischen finden auch Sicherheitssysteme auf der Grundlage maschi- 
neller Umgebungswahrnehmiing zunehmend Einzug in Neufahrzeuge. Beispiels- 
weise kann der automatische .Noibrenisassistent selbsistiindig eine Gefahrenhrem- 
sung durchführen, um die l'olgcn eines Unfalls zu vermindern. ZusiitzHche Mtig- 
lichkeiten ergeben sich durch die dralillose Kommunikalion zwischen Faiirzcugen. 
Mit ihrer Hilfe kann vor Gefahrenstellen gewarnt werden, die außerhalb des visuell 
wahrnehmbaren Bereichs liegen. Darüber hinaus ist die Vereinbarung kooperativer 
Fahrmanöver denkbar. Besonders in Gefahrensitualionen mit mehreren beteiligten 
Fahrzeugen sind Fahrer aufgrund von Reaktionszeiten und fehlender Koordinati- 
onsmögUchkeitra häufig nicht in der Lage, rechtzeitig die optimalen Handlungen 
zur Unfallveimeidung einzuleiten. Hier könnte ein zuldinftiges Assistenzsystem 
eingreifen und automatisch ein kooperatives Fahrmanöver zur Abwendung der Ge- 
fahr planen und ausführen. 

Diese Arbeit bcfasst sich mit Algorithmen zur Planung des kot)perativen Verhal- 
tens kognitiver Automobile. Ausgangspunkt sind kognitive Fahrzeuge mit Senso- 
ren und Aktoren, die ihre Umgebung wahrnelinien, Verkelussituaiionen interpre- 
tieren, über Funk kommunizieren und automatische Fahrmanöver ausführen kön- 
nen. 

Zunächst wird die Frage uniersuchl. welche Fahrzeuge überhaupt im Hinblick 
auf gemeinsame Fahrmanöver miteinander kooperieren können. Diese Fahrzeu- 
ge werden zu kooperativen Gruppen zusammengefasst. Das Konzept der ko- 
operativen Gruppen ermöglicht eine rasche F.nlscheiclungstindimg im Fall ei- 
ner Gefahrensiluaiion, da die Kooperaiumsparincr durch die Gruppensirukiur be- 
reits festgelegt sind. Eine begrenzte Gruppengröße garantiert außerdem, dass der 
Kommunikations- und Rechenaufwand vertretbar bleibt Für die Bestinmiung der 
möglichen Kooperationsparmer ist die Straßentoin iogie von entscheidender Be- 
deutung. Beispielsweise ist die Durchführung gemeinsamer Fahrmanöver nicht 
möglich, wenn Fahrzeuge durch die Mittelleiqplanke einer Autobahn voneinan- 
der getrennt sind, obwohl ihr räumlicher Abstand in diesem Fall sehr gering sein 
kann. Anhand dies«: Überlegungen wird ein Abstandsmaß definiert, das die Zeit 
bis zum nächsten gemeinsamen Tref^unkt zweier Fahrzeuge im Straßennetz be- 
schreibt. Darauf basierend werden Kriterien zur Bildung kooperativer Gruppen im 
verteilten System kognitiver Fahrzeuge entwickelt 
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Zusammer^sung 



Der zweite Hauptbeitrag der Arbeit behandelt die Entscheidungsfindung in Gefah- 
rensituationen. Um möglichst allgemeine, von speziellen Szenarien unabhängige 
Verfahren zu erhalten, wird die kooperative Unfallvermeidung als Problem der Be- 
wegungsplanung für mehrere Fahrzeuge formalisiert. In der Literatur zur koope- 
rativen Bewegungsplanung für mehrere Fahrzeuge oder Roboter werden meistens 
Entkopplungs- oder Priorisierungsannahmen getroffen, um die Rechenkomplexi- 
tät der Algorithmen zu reduzieren. Damit wird jedoch auch die Menge der mögli- 
chen Bewegung^läne eingeschränkt, sodass die Planung fehlschlagen kann, selbst 
wenn eine Lösimg existiert. In dieser Arbeit wird auf solche Annahmen verzich- 
tet, um in (icfahrcnsituatit)nen einen möglichst großen Spielraum von Ilandlungs- 
kombinationen ausscliöpton zu können. Es werden drei unterschiedliche Verfahren 
zur kooperativen Bewegungsplanung unter Berücksichtigung der Fahrzeugdyna- 
mik untersucht. 

Der erste Algorithmus basiert auf der Anordnung einer diskreten Menge von 
Handhingssequenzen der Fahrzeuge in einem Baum. Eine gewählte Handlung wird 
für ein festgelegtes Zeitintervall ausgeführt, bis der nächste Entscheidungspunkt 
auf der nachfolgenden Ebene des Baums erreicht ist Die Ausführung der Handlun- 
gen w ird mit Hilfe von Fahrzeugmodellen unter Berücksichtigung kinematischer 
und dynamischer Randbedingungen simuliert. Zur Bewertung von Alternativen 
können Funktionen definiert werden, die nicht nur die Kollisionsveimeidung, son- 
dern auch die Minimicrung der Unfallschwcrc im Fall unvermeidlicher Kollisionen 
ermöglichen. Aulgrund der großen Anzahl an Kombinationen \'on Finzelfahrzeug- 
handlungen ist es bei siinivollen Diskrelisierungsannahmen nicht möglich, den 
Baum m Echlzeit vollslandiii zu durchsuchen. Jedoch können bestimmte Teilbäu- 
me von der Suche ausgeschlossen werden, wenn bekannt ist, dass sie die optimale 
Eösung nicht enthalten können. Hierzu wird in einem Vor\'erarbeitungsschntt die 
Informadon berechnet, die nur von Lntscheidunüen emzeluer l ahrzeuiie ablianui>i 
ist. Auf der Grundlage dieser Vorberechnung wird ein effizientes Durchsuchen des 
Baums mit dem Branch-and-Bound- oder dem A*-Algorithmus möglich. 

Das zweite Verfahren modelliert die kooperative Kollisionsvermeidung als ge- 
mischt-ganzzahliges lineares Programm. Dieser Ansatz wird in der Literatur zur 
kooperativen Bewegungsplanung für Flugzeuge eingesetzt. In dieser .Arbeit wer- 
den verschiedene Erweiterungen vorgencmimen, um die Fahrzeuggeometrie und 
das Straßennetz berücksichtigen zu können. 

Das dritte in dieser Arbeit votgeschlagene VerfEihren zur kooperativen Bewegungs- 
planung basiert auf d^ Methode der elastischen Bänder, die in der Literatur zur 
Einzelfahrzeugbahnplanung eingesetzt wird. Die geplante Bewegung eines Fahr- 
zeugs wird als eine Sequenz von Knoten modelliert, wobei jeder Knoten die Posi- 
tion des Fahrzeugs zu einem festgelegten Zeitpunkt repräsentiert In Analogie zu 
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einem Feder-Masse-System wirken verschiedene Kräfte auf die elastischen BSn- 
dN, Innere Kräfte erzwingen eine glatte Abfolge der Knoten gemäß den fahrdy- 
namischen Grenzen. Äußere Kräfte stoßen die Knoten vom Straßenrand, von Hin- 
dernissen und von anderen Fahrzeugen ab. Im Kräftegleichgewicht ergibt sich ein 
kooperativer Bewegungsplan. 

Die beschriebenen Verfuhren zur Bildung kooperativer Gruppen und zur Planung 
kooperativer Fahrmanöver werden mit Hilfe eines Verkehrssimulators evaluiert. 
Die kooperative Unfallvermeidung wird in verschiedenen Kreuzungs-, Ausweich-, 
Einfädel- und Überholszenarien demonstriert. Dabei werden kooperative Fahr- 
manöver für zwei bis sechs beteiligte Fahrzeuge geplant. Die Leistungsföhigkeit 
der voi:geschlagenen Algorithmen wird mit dem Standardverfahren der prioritäts- 
basierten Planung verglichen. Das Potential für einen echtzeitföhigen Einsatz der 
kooperativen Bewegungsplanung wird aufgezeigt 
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Kapitel 1 



Einleitung 



1.1 Motivation 

Trotz eines gestiegenen Verkehrsaufkommens ist die Anzahl der im Straßen- 
verkehr tödlich verunglückten Personen in Europa seit Jahrzehnten rückläufig 
IINic(HlcniclO| . Allgemein geht man davon aus, dass diese Entwicklung auch auf 
die verbesserte passive und aktive Sicherheit der Fahrzeuge zurückzuführen ist 
|l lackenbergO 1 lMarchauT)S]|liidehall()7| . Einen wesentlichen Beitrag zur aktiven 



Sicherheil leisten Fahrerassislen/systeme, die in den letzten Jahren eine zuneh- 
mende Verbreitung erfahren haben IWinner09bl Ashley09| . Notbrems- und Aus- 



weichassistenten, die zur Kollisionsvermeidung in die Steuerung des Fahrzeugs 
eingreifen, befinden sich in der Entwicklung bzw. sind bereits am Markt verfügbar 
|Ziegler08b]lJansson02ilSchniidt()6lly\DA('09i. Grundsätzlich werden Assistenz- 



sysleme von einer Mehrheil der Fahrer als wünschenswert und nützlich angese- 
hen (E u r o p e a n C ' o m m i s s i 0 nO 6 1 , gegen einen automatischen Eingriff ohne explizite 
Zustimmung des Fahrers gibt es aber häufig Vorbehalte. Beispiele aus dem Luft- 
verkehr sowie vollautomatisch betriebene D-Bahnen llRicchcrs02l zeigen jedoch, 
dass in verwandten Anwendungsbereichen durchaus Akzeptanz für solche Tech- 
nologien vorhanden ist. 

Zusätzliche Möglichkeiten eröffnet die Funkkommunikation zwischen Fahrzeu- 
gen, die zur Zeit intensiv erforscht wird HHartenstcinüSI . Neben Informations- und 
IJnterhaltungsanwendungen können auch Sicherheitssysteme von der drahtlosen 
Kommunikation profitieren. Bisher wurden vorwiegend Warnsysteme untersucht, 
die den Fahrer beispielsweise auf eine Unfallstelle aufmerksam machen. Eine we- 
sentlich darüber hinaus gehende Anwendungsmöglichkeit ist die Abstimmung von 
automatischen kooperativen Fahrmanövern. Ein derartiges System könnte nach 
den erwähnten Notbrems- und Ausweichassistenten die nächste Stufe der Fah- 
rerassistenz darstellen. In vielen Gefahrensituationen, an denen mehrere fahrende 
Fahrzeuge beteiligt sind, könnte ein solcher Ansatz eine effektivere Unfallvermei- 
dung bewirken als Assistenzfunktionen auf Einzelfahrzeugcbene. Wenn eine Kol- 
lision nicht mehr verhindert werden kann, könnte zumindest die Unfallschwcrc 
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I 1^ — ^^pm" wechseln [^| | 

Bremsen Bremsen Boschk-uniycn 

Abbildung 1.1: Mögliche kooperative Fahrmanöver in einer Gefahrensituation bei 
einem Überhol Vorgang mit Gegenverkehr. Durch Bremsen bzw. Beschleunigen der 
zu überholenden Fahrzeuge ensteht eine Lücke für den vSpurwechsel des überho- 
lenden Fahrzeugs. 



verringert werden. Aus anderen Bereichen ist bekannt, dass kooperative Entschei- 
dungen eine Verbesserung gcueniihLM- individuellen Entscheidungen der einzelnen 



Beteiligten erreichen können ]Roughgardcn().S| . Vor diesem Hintergrund erscheint 



es sinnvoll, das Potenzial koopcraiixer I ahrmanöver im Straßenverkehr zu unter- 
suchen. 

In dieser Arbeit wird von einer Gefahrensituation mit mehreren beteiligten Fahr- 
zeugen ausgegangen. Darunter wird eine Verkehrssituation verstanden, in der ein 
rasches Handeln erforderlich ist, um einen Unfall zu verhindern. Ursache der Ge- 
fahrensituation können riskantes oder unachtsames Verhalten eines der beteiligten 
Fahrer, Fehlverhallen eines anderen Verkehrsteilnehmers, technische Probleme an 
einem Fahrzeug oder äußere Einflüsse sein. Neben offensichtlichen Unfallursa- 
chen wie Missachtung der Vorfahrt oder riskante Überholmanöver seien hier er- 
wähnt: Fußgänger, die unvorsichtig auf die Fahrbahn treten, verlorene Ladung, auf 
die Fahrbahn gestürzte Bäume. Steinschlag, Reifenschaden. Diese Beispiele zei- 
gen, dass Gefahrensiluationen auch im Fall einer vollständigen Automatisierung 
des Straßenverkehrs auftreten können, bei der Fahrerfehler als Gefahrenursache 
ausscheiden. Die in dieser Arbeit untersuchten Algorithmen zur Kooperation ko- 
gnitiver Automobile sind daher sowohl für ein Fahrerassistenzsystem als auch für 
ein vollständig automatisiertes Straßenverkehrssystem anwendbar. 

In einer solchen Gefahrensituation mit mehreren beteiligten Fahrzeugen sind die 
Fahrer nur selten in der Lage, die optimalen kollisionsvermeidenden Fahrmanöver 
auszuwählen und durchzuführen. Ein wichtiger Grund besteht darin, dass es für 
die Fahrer nahezu unmöglich ist, ihre Handlungen untereinander abzustimmen. 
In einem Szenario wie in lAhb. l.ll kann es z. B. unter den Fahrern verschiede- 



ne Auffassungen darüber geben, zwischen welchen Fahrzeugen der Überholende 
auf die rechte Spur wechseln soll. Die Initiierung und Ausführung der erforder- 
lichen Manöver durch die Fahrer wird in einem solchen Fall länger dauern als 
bei opdmal abgestimmten kooperativen Fahrmanövern. Diese Verzögerung kann 
dazu führen, dass ein Unfall nicht mehr verhindert werden kann. Auch in ande- 
ren Szenarien besteht die Problematik der fehlenden Absdmmungsmöglichkciten. 



I 



Abbildung 1.2: Situation, in der ein Unfall nur verhindert werden kann, indem die 
Fahrzeuge entgegen der Intuition links aneinander vorbeifahren. 



Bei Gefahrensiiuationen an einer Kreuzung muss z.B. geklärt werden, welches 
Fahrzeug zuerst die Kreuzung passiert. Besonders wichtig ist eine Koordination 
auch dann, wenn ein Unfall nur durch unübliche Handlungen vermieden werden 
kann, beispielsweise indem entgegenkommende Fahrzeuge links aneinander vor- 
beifahren, weil ein Ausweichen nach rechts aus (Iründen der Dynamik und des 
Slraßenverlaufs zwangsläufig zu einem Unfall führt. Mögliche Ursachen sind ein 
Hindernis, rutschiger Straßenbelag durch eine Ölspur oder überhöhle Geschwin- 



digkeit in einer Kurve, wie in Abb. 1 .2 dargestellt. Solche Situationen sind für die 
Fahrer sehr schwierig einzuschätzen. Sie werden dazu tendieren, die gewohnten 
Manöver zu versuchen, in diesem Fall also ein Passieren auf der rechten Seite. 
Fehlende Koordination kann auch bei der Interaktion mehrerer Fahrerassistenz- 
systeme für Einzelfahrzeuge zu suboptimalem Verhalten führen IHillenbrandQ6l . 

Neben dem Aspekt der fehlenden Koordinationsmöglichkeiten, der speziell in Si- 
tuationen mit mehreren beteiligten Fahrzeugen auftritt, gibt es auch weitere Grün- 
de, weshalb Fahrer in Gefahrensituationen häufig nicht optimal handeln. Zu nen- 
nen sind hier unter anderem die menschliche Reaktionszeit, die Schwierigkeit, 
mögliche Manöver hinsichtlich ihrer tahrdynamischen Durchführbarkeit zu beur- 
teilen, und die fehlende Erfahrung im Umganu mit den selten auftretenden Ge- 
fahrensiluationen. Eine Folge davon ist beispielsweise, dass ein Fahrer selbst bei 
der Entscheidung für eine Notbremsung das Bremspedal häufig nicht mit ausrei- 
chender Kraft tritt. Solche Beobachtungen eröffnen ein Potenzial für automatisch 
eingreifende Sicherheitssysteme und sind bereits in die Entwicklung von F\ihreras- 
sistenzsystemen auf Einzelfahrzeugebene eingeflossen lKiesewetter97l . 



1.2 Ziele 

In dieser Arbeit wird ein Konzept zur Kooperation kognitiver Automobile unter- 
sucht, das in Zukunft zur Verbesserung der Verkehrssicherheit bein^agen könnte. In 
Gefahrensituationen mit mehreren beteiligten Fahrzeugen soll das System cingrei- 
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ton und durch die automatische Ausführung kooperativer Fahrmanöver Unfälle 
verhindern oder zumindest die Unfallschwere reduzieren. 

Das vorgeschlagene Konzept beginnt mit der verteilten Bildung von kooperativen 
(Iruppen. die eine Struktur lür die weitere Verarbeitung und Entscheidungsfindung 
darstellen. .lede Gruppe baut ein gemeinsames Lagebild auf, das die relevante In- 
formation über die aktuelle Verkehrssituation enthält und als Grundlage für die 
Erkennung von Gefahrensituationen dient. Wenn eine Kollision droht, wird mit 
Hilfe von Bevvegungsplanungsalgorithmen ein kooperatives Fahrmanöver geplant, 
das von den beteiligten Fahrzeugen ausgeführt wird. Durch die Beschränkung der 
Siluationserkennung und Verhaltensentscheidung auf die Fahrzeuge einer Gruppe 
kann der Rechen- und Kommunikationsaufwand in handhabbaren Grenzen gehal- 
ten werden. 

Ziel der Arbeit ist, geeignete Algorithmen für die Kooperation von Fahrzeugen zu 
finden und die grundsätzliche Machbarkeit des Konzepts in der Simulation zu zei- 
gen. Der Schwerpunkt liegt auf den Algorithmen für die Gruppenbildung und für 
die Planung k(Kipcrativcr Fahrmanöver. Fs wird ein möglichst gencrischcr Ansatz 
verfolgt, der prinzipiell eine beliebige Anzahl beteiligter Fahrzeuge berücksichti- 
gen kann und nicht auf eine bestimmte Verkehrssituation oder Straßengeometrie 
beschränkt ist. 

Die Arbeit erhebt nicht den Anspruch, eine vollständige Systemspezifikation 
zu erstellen und alle damit verbundenen Fragen zu adressieren. Nicht behan- 
delt werden insbesondere sensorielle Wahrnehmung IMaurcrO?] |Dickmannsü7l , 
Informationsfusion |Tisclilcr().'S| . Architekturen und Protokolle zur Fahrzeug- 
Fahrzeug-Kommunikalion Iii larienstein08| NagelOT Raya()6| , juristische Aspek- 
le (MeyerO?" |Be\vcrsdorl'()3l SavelsbergO.'S| |, Fragen der Mensch-Maschine-Inier- 
akiion j König09| iBraessOöl. der Akzeptanz des Systems bei Fahrern ll\V'ahl08l 



Maees09 



, der Zulassung llGotteif)61IWinner09cl . der Markteinführung INöcker05l 



Savclshcrgf).S| und der Nutzenhewertung HBuschOSUKillatOSl 



1.3 Beiträge 

Die Ilauptbeiträge dieser Arbeit liegen auf den Gebieten der Bildung kooperati- 
ver Gruppen und der Bewegungsplanung für kooperierende Fahrzeuge. Zusätzlich 
wird untersucht, welche Information für die Kooperation von Fahrzeugen im Stra- 
ßenverkehr benötigt wird und wie diese im gemeinsamen Lagebild repräsentiert 
werden kann |Frcsc08allBatz06t . 



1.3 Beiträge 
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Bei der Bildung kooperativer Gruppen sind die wesentlichen Beiträge dieser Ar- 
beit 

• die Definition und algorithniische Berechnung eines Abstandsmaßes für 
Fahrzeuge im Straßennetz |Frese07hK 

• Bewerlungskriterien und Algorithmen zur Partiiionierung von Fahrzeugen 
in kooperative (Iruppen iFreseOBbl . 

• ein Verhandlungsprotokoll zur verteilten Gruppcnbildung |Frese07al . 
Die Beiträge zur Bewegungsplanung sind 

• die Formalisierung der Planung kooperativer Fahrmanöver als Problem der 
kooperativen Bewegungsplanung und die Definition eines Verlustfunkdo- 
nals zur Bewertung von Bewegungsplänen u. a. im Hinblick auf Kollisions- 
freiheit und Kollisionsschwere |Frese09a| , 

• die Untersuchung verschiedener Bewegungsplanungsalgorilhmen und deren 
Vergleich mit dem vStandardansatz der prioritätsbasiertcn Planung. Hierzu 
werden umfangreiche Simulationen in Bezug auf Planungserfolg und Re- 
chenaufwand ausgewertet iFresel Ibl . 

Folgende Algorithmen zur kooperativen Bewegungsplanung sind im Rahmen die- 
ser Arbeit entstanden bzw. wurden aus anderen Einsatzgebieten übertragen und 
wesendich erweitert: 

• Ein Algorithmus repräsentiert kooperative Handlungssequenzen in einem 
Baum und ermöglicht mittels vorberechneter Schranken für das Verlustfunk- 
tional eine effiziente Suche nach der besten Handlungssequenz in diesem 
Baum iFrcscIOairrrcscICibl . 



• Die Formulierung des Bewegungsplanungsproblems für mehrere Flugzeuge 
als gemischt-ganzzahliges lineares Programm wird in dieser Arbeit auf den 
Stra[3enverkehr übertragen IFresel lal . 

• Die Methode der elastischen Bänder wurde bisher zur Bewegungsplanung 
für Einzelfahrzeuge eingesetzt und wird in dieser Arbeit auf die Planung 
kooperativer Fahrmanöver in Gefahrensituationen angewandt IFreseQ9bl . 



Das vorgeschlagene Konzept und seine Komponenten werden mit Hilfe eines Ver- 
kehrssimulators evaluiert. 
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1.4 Gliederung 



Diese Arbeil beginnt niii einem Uberblick über den Stand der Forschung in 



Ka- 



pitel 2| Dort wird auf die Verhallensentscheidung für Einzelfahrzeuge, auf An- 
sätze zur Kooperation und auf Algorithmen zur Bcwegungsplanung eingegangen. 
Kapitel 3] stellt das Konzept zur verteilten Kooperation kognitiver Automobile in 
Cierahrcnsituationen vor. Außerdem werden für die Kooperation im Straßenver- 
kehr relevante Begriffe definiert und in eine strukturierte Wissensrepriisentation 



für das gemeinsame Lagebild eingeordnet. [Kapitel 4| behandelt die Bildung ko- 
operativer Gruppen. Ausgehend von den gewünschtLMi Eigenschaften einer Gruppe 
werden ein Abstandsmaß und eine Bewertungsfunktion für kooperative Gruppen 
definiert. Außerdem werden Partitionierungsalgorithmen und ein Verhandlungs- 
protokoll zur verteilten Gruppenbildung behandelt. In fKapucTTI werden drei ver- 



schiedene Algorithmen zur Planung kooperativer Fahrmanöver für mehrere Fahr- 
zeuge beschrieben. Für jeden Algorithmus sind die Nebenbedingungen an koope- 
rative Bewegungspläne wie Kollisionsvermeidung, Fahrzeugdynamik und Fahr- 



bahnbegrenzungen geeignet zu modellieren. Kapitel 6 beschreibt die Ergebnisse 



zur Gruppenbildung und Bewegungsplanung, die mit Hilfe eines Simulationssys- 
tems erzielt wurden. Insbesondere wird eine vergleichende Bewertung der ver- 
schiedenen Bewegungsplanungsalgorithmen vorgenommen. [Kapitel 7| enthält eine 
Zusammenfassung der Ergebnisse und einen Ausblick auf zukünftige Arbeiten. 
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Stand der Forschung 



Für die in dieser Arbeit verfolgten Ziele ist der Stand in verschiedenen Ge- 
bieten der Forschung relevant, da einerseits Methoden aus dem Bereich von 
Automatisicrungs- und Fahrerassistcnzfunkrioncn für ninzclfahr/cuge auf koope- 
rative Probleme verallgemeinert werden können, und andererseits Ansätze zur Ko- 
operation aus verwandten Gebieten wie Robotik und Luftverkehr auf kognitive 
Automobile übertragen werden können. In diesem Kapitel werden zunächst einige 
Arbeiten zu Einzclfahrzcugcn erwähnt und anschließend Methoden der Koopera- 
tion in verschiedenen Anwendungsgebieten skizziert. Schließlich ist ein eigener 
Abschnitt den Algorithmen zur Bahn- und Bewegungsplanung gewidmet, die eine 
Grundlage für die Planung kooperativer Fahrmanöver in der vorliegenden Arbeit 
bilden. 



2.1 Autonome Fahrzeuge und 
Fahrerassistenzsysteme 



Forschungsarbeiten zum automatischen Fahren gab es bereits Anfang der 1960er 
Jahre |Breuning62) . Jahrzehnte später wurde das großangelegte europäische For- 
schungsprogramm Prometheus durchgeführt |Braess95l [NagelOS] . Die ehrgeizi- 



gen Ziele dieses Projekts konnten zwar nicht erreicht werden, viele Teilergeb- 



nisse gingen jedoch in heutige Fahrcrassistcnzsystcmc wie ACC ein (vgl. Ab- 



schnitt 2. 1.2f . Der Schwerpunkt der meisten Forschungsprojekte zu autonomen 



Fahrzeugen liegt auf der Wahrnehmung. Darauf wird hier nicht weiter eingegan- 
gen, für einen Überblick zum Thema Wahrnehmung für kognitive Fahrzeuge siehe 
IMaurcr05[rVacek08l(Dirkmanns07l . 
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2.1.1 Verhaltensentschcidung für autonome Fahrzeuge 

Im Vergleich zur Wahrnehmung ist die Verhaltensentscheidung in vielen Arbeiten 
zum autonomen I-ahren sehr einlach gehalten, z. B. indem direkt aus der wahrge- 
nommenen Fahrspurgeometrie ein Lenkbefehl berechnet wird ||.lochem96[|Fritz04l 
IHeimesOH . Weitere Ansätze für das Fahrzeug verhallen sind Fähigkeilennetze 
mit unscharfen Regeln IPellkol"er03l . biologisch motivierte Verhaltensnetzwerke 
IlSch rekle r()9| . Bayes'sche Verfahren [ lForhes95l DöTgövÜ5), Entscheidungsbäume 



||VVcllman9.'SllBroadhurslQ4| sowie hierarchische endliche Automaten mit Zustän- 



den wie Spurfolgen, Vorfahrt gewähren. Einparken. Stau jOzgimerÖ? iKanimeKTSl 



IMontemerloQSI . Entscheidungen zum Überqueren von Kreuzungen und zum Ein- 
fädeln in den fließenden Verkehr werden meist anhand von Zeidücken getroffen 
IUrmson08l|W^erling08a| . 



Der Stand der autonomen Fahrzeuge zahlreicher Forschungsgruppen, vorwiegend 
aus den USA, wurde bei den Grand Challenges und der Urban Challenge 2007 der 
DARPA demonstriert. Wälirend bei der Clrand Challenge das Fahren im wüsten- 
ähnlichen Gelände gelordert wurde, beinhaltete das Szenario der Urban Challenge 
das Fahren im Verkehr auf Straßen, Kreuzungen und Parkplätzen unter Einhal- 
tung der entsprechenden Verkehrsregeln. Einige Versuchsfahrzeuge konnten die- 
se Aufgaben überwiegend erfolgreich bewältigen, wobei für die Verhaltensent- 
scheidung häufig endliche Automaten zum Einsatz kamen llKammel09l . Obwohl 
die Anforderungen des Szenarios verglichen mit dem realen Verkehrsgeschehen 
als eher eingeschränkt zu bezeichnen sind, kam es zu einigen Zwischenfällen 
||Fletcher081lUrmson08l . Bevor ein Einsatz im Straßenverkehr möglich wird, muss 



insbesondere die Zuverlässigkeit autonomer Fahrzeuge deutlich verbessert werden 
IThrunlOll . 



2.1.2 Fahrerassisteiizfuiiktioneii 

Bei Fahrerassistenzsvstemen für Einzelfahrzeuee lassen sich Komfort-, Warn- und 
Sicherheitssysteme unterscheiden I S i i 1 le r05 1 ITi de ma nTTH . Komfortfunktionen un- 
terstützen den Fahrer bei seinen Aufgaben, er bleibt jedoch in der alleinigen 
Verantwortung für die sichere und korrekte Fahrzeugführung. Zu den heute ver- 
fügbaren Komfortsystemen gehören radarbasierte Abstandshaltcsystcmc (Adap- 
tive Cruise Control, ACC), Spurhalteassistenten und Einparkhilfen |Winner(»h| 
|Vahidi03T>llJustus(r7]| . Komfortsysteme benötigen eine besonders sorgfältig gestal- 



tete Mensch-Maschine-SchnittstcUe, damit sie nicht eine nachlassende Aufmerk- 
samkeit des Fahrers zur Folge haben |König09' WcycrU6a IBohnlOI . 
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Warnsystcme machen den Fahrer rechtzeitig auf eine drohende Gefahr aufmerk- 
sam. Die DurchlYihrung einer geeigneten Handlung zur Abwendung der Gefahr 
bleibt jedoch Aufgabe des Fahrers. Daher sind die Wahrnehmung und die Interpre- 
tation der Verkehrssituation die wichtigsten Komponenten eines Warnsystems. An- 
wendungen umfassen Warnungen vor Auffahrunfälien, bei der Missachtung von 
Vorfahrtsregein. vor unbeabsichtigtem Verlassen der Spur und bei riskanten Spur- 
wechsehi llSeiler98l fÖnken941 |Iöäw98] ersten berg06| [W^TÖTl iGoodrichQÖI . In 
diesen Fällen genügt es meist zur Abwendung der Gefahr, wenn der Fahrer ein 
begonnenes Manöver abbricht. 

Sicherheitssysteme, die direkt in das Fahrverhaltcn eingreifen und vom Fahrer 
nicht überstimmt werden können, sind bisher vor allem auf der Stabilisicrungs- 
ebene verbreitet: Das Antiblockicrsystem (ABS) und das elekti^onischc StabihtäLs- 
programm (ESP) sind nicht auf die Wahrnehmung der Umgebung angewiesen und 
erreichen daher eine hohe Zuverlässigkeit |vZantenü91IStillerÖ5l . 

Zu den ersten wahrnehmungsbasierten, autonom eingreifenden Sicherheitssys- 
temen gehört der Notbremsassistent |Winnerü9a| |JanssonO'2l |Hillenbrand07| 
IMcCallOT] IBrännströmOSI . Auch Ausweichassistenten wurden untersucht, ha- 
ben aber größtenteils noch nicht die Marktreife erreicht liSchmidt()6| LagcsO I [ 
ILammen92l|AmelingQ2|IIsermannQ8UKirchnerQ5[|ADACQ9| . Diese Systeme be- 
trachten typischerweise nur ein einzelnes Hindernis und berücksichtigen den 
Straßenverlauf nur eingeschränkt oder überhaupt nicht. Entscheidungen werden 
i.d. R. anhand der verbleibenden Zeit bis zur drohenden Kollision (timc to colli- 
sion) getroffen (ZhangOö) . Die Trajcktorie für ein Ausweichmanöver ergibt sich 
meist durch die Festlegung der Parameter einer vorgegebenen Kurve. 

Ein System, das riskante Spurwechsel durch einen Eingriff in die Lenkung verhin- 
dert, ist in liEidehall07| beschrieben. Schließlich wurde eine Assistenzfunktion un- 
tersucht, die eine Kollision mit einem entgegenkommenden Fahrzeug verhindern 
soll. Mit einem spieltheoretischen Ansatz wurde eine komplexe Ausweichstrate- 
gie hergeleitet, wobei das ungünstigste Verhalten des Gegenverkehrs angenommen 
wird IILachnerQOI . 



2.1.3 Wissensrepräsentation 

Systeme mit umfangreicheren Wahrnehmungsfähigkeiten beinhalten häufig eine 
rechnerinterne Repräsentation der relevanten Fahrzeugumgebung, die als Grund- 
lage für die Siluationserkennung und Verhaltensentscheidung dient. Die Modellie- 
rung gliedert sich meist in zwei Hauptteile: Die wahrgenommenen Objekte, ins- 
besondere Verkehrsteilnehmer, mit einer Beschreibung von Typ, Geometrie, Ort, 
Geschwindigkeit, etc., und das Straßcnnetz bestehend aus Fahrspuren, Kreuzungen 
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und Verkehrszeichen. Dieses Grundprinzip findet sich sowohl in älteren als auch 
in aktuellen Arbeilen I.ludaschke94llt-urdal(>l Ligner 1()| . Typischerweise wird eine 
objeklorientierte Modellierung mit Vererbungshierarchie und Aggregationen ver- 
wendet | |Knaup 1(1 ITomäsO^lH Iuhn9 fj . Bei einigen Ansätzen ist eine Repräsenta- 
tion der Wahrnchmungsunsichcrhciten vorgesehen |Papp()8| . 

Zusätzlich lassen sich Relationen zwischen den Repräsentanten spezifizieren 
IM ückOOl . Beispielsweise ist es von Bedeutung, ob zwei Fahrspuren benachbart 
sind und ob Abbiegevorgänge zueinander in Konflikt stehen (RegeleOS Zhang09) . 
Von iHummcl09| wurde eine Repräsentation des Straßennct/es in einer Bc- 
schrcibungslogik erstellt, die auch zur Infcrcnz genutzt werden kann. Ein ver- 
wandtes Problem ist die Repräsentation von annotierten digitalen Straßenkarten 
I SchrautOlTl . IHarianclOOl modelliert Verkehrsregeln aus der Straßenverkehrsord- 
nung. IDickmannsü5l repräsentiert die Fahrzeugumgebung in Form eines Szenen- 
baums. 

Einzelne Modelle wurden speziell im Hinblick auf die Integration kooperativer 
Wahrnehmung entwickelt |Papp08|[Zennaro03l . 



2.1.4 Situationserkennung 

Die Erkennung und Bewertung der aktuellen Verkehrssituation sowie des Verhal- 
tens der Verkehrsteilnehmer ist ein wichtiger Bestandteil vieler Assistenzsysteme 
und autonomer Fahrzeuge. 

Ein verbreiteter Ansatz zur Situationserkennung sind probabilistische Verfahren 
wie Bayes'sche Netze |Forbes93l fGcrdes06l [ÜViser 1 Ol [OlüITiIÜl ICTindcTcTÖ^ und 



Hiddcn Markov Modelle |Boyraz07[IOIiver091peyer-Delius09| . 



In lLattner05| werden Siluationsmuster verwendet, die auf aussagenlogischen 
Zeitintervallrelationen basieren. Ein ähnlicher Ansatz findet sich in I('hisalita07l . 
Unscharfe Regeln zur Situationsanalysc werden von Hl lcrmann07| eingesetzt. Die 



Situationserkennung mit Hilfe von Situationsgraphenbäumen wird in |Krüger92 
HaagOO) behandelt. Fallbasiertes Schließen zur Situationsinierpretation wurde von 



llVacek081l untersucht. 
| Mock-Heckcr94| beschreibt einen zweistufigen Prozess zur Erkennung von Kon- 



flikten zwischen Verkehrsteilnehmern. Zunächst werden die Pläne der Verkehrs- 
teilnehmer unabhängig von den Ausführungszeitpunkien der Handlungen auf qua- 
litative Konflikte, verursacht z.B. durch die Benutzung derselben Fahrspur, un- 
tersucht. Falls ein qualitativer Konflikt vorliegt, wird anschließend eine genaue- 
re Analyse unter Berücksichtigung von quantitativer Orts- und Zeitinformation 
durchgeführt. 
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Bei einigen Ansätzen ist die Möglichkeit vorgesehen, aus den Ergebnissen der 
Situationserkennung direkt eine Verhaltensentscheidung abzuleiten |Krliger92| 

I-orhcs95 1 ILaitner05l . 



2.1.5 Prädiktion 

Eine weitere Möglichkeit zur Situationsbewertung bieten Prädiktionsverfahren. 
Ausgehend von den aktuell wahrgenommenen Positionen und Handlungen der 
Fahrzeuge werden ihre zukünftigen Positionen vorhergesagt. Aufgrund der An- 
nahmen über die zukünftigen Handlungen sowie der Wahrnehmungsunsicherheit 
ist die Vorhersage mit Unsicherheit behaftet. Diese Unsicherheit wird häufig ex- 
plizit berechnet, etwa in Form einer Kovarianzmatrix. 

Zur Prädiktion werden überwiegend verschiedene Varianten des Kaiman-Filters 
eingesetzt, etwa das erweiterte Kaiman-Filter oder das Unscented Kaiman Fil- 
ter IJansson02irran06l CaveneyOT) . Außerdem finden sich in der Literatur Mon- 



te-Carlo-Verfahren sowie Erreichbarkeitsanalyse basierend auf Markov-Ketten 
llEidchall061IBnxKlhurs(()51lAlth()ri"Ü0| . Die zur Prädiktion verwendeten Zustands- 



raummodelle der Verkehrsteilnehmer unterscheiden sich hinsichtlich der verwen- 
deten Zustandsvariablen und der benötigten Fahrzeugparameter. 

Da die zustandsbasierte Prädiktion auf der Annahme konstanter Handlungen be- 
ruht, kann sie nur innerhalb eines kurzen Zeithorizonts zuverlässige Ergebnisse 
liefern. Längerfristige Prädiktion erfordert die Berücksichtigung weiterer Infor- 
mation wie Straßenverlauf und erkanntes Verhalten lHesse921 |Schlen()rt"04| . Die 
Prädiktion unter Einbeziehung eines Fahrspurmodells ist in |Polychronopoulos07) 
beschrieben. Das Verfahren von | |ZhangQ9| verwendet Übergangswahrscheinlich- 
keiten zwischen den Fahrspuren einer Kreuzung zur verhaltensbasierten Prädikti- 
on der Fahrzeugposition, Von IBroadhurst051 IAlthoff09l werden Prädiktionsver- 
fahren vorgeschlagen, welche die Interaktion mehrerer Verkehrsteilnehmer be- 
rücksichtigen. Die Annahme einer kollisionsvermeidenden Fahrweise wird von 
IEidehall06ll zur Prädiktion der Fahrzeugpositionen verwendet. In lAlthofflQI 
wird eine Sicherheitsbewertung für kooperative Fahrmanöver basierend auf Er- 
reichbarkeitsanalyse beschrieben. 

Auf der Grundlage der prädizierten Fahrzeugpositionen kann eine Erkennung von 
Gefahrensituationen durchgeführt werden. Hierzu wird i,d, R. die Wahrschein- 
lichkeit für eine Kollision zweier Fahrzeuge berechnet flLamhcrtOHl IJansson02l 



lBroadhurst051 ITanÜöl | Althoff09| . In ||Batz09| wird hingegen der minimale prädi- 



zierte Abstand zwischen den wahrscheinlichen Aufenthaltsbereichen der Fahrzeu- 
ge als Kriterium für eine Gefahrensituation verwendet. 
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2.2 Kooperation von Fahrzeugen oder Robotern 

In diesem Abschnitt wird ein Überblick über verschiedene Ansätze zur Koope- 
ration gegeben. Als Anwendungsgebiete werden neben dem Straßenverkehr auch 
Robotik und Luftverkehr betrachtet, da viele dort untersuchte Kooperationsme- 
chanismen potenziell auch auf kognitive Fahrzeuge übertragbar sind. Zu unter- 
scheiden ist, ob die Kommunikation zur Abstimmung kooperativer Handlungen 
oder lediglich zur Situationswahrnehmung und Gefahrenwarnung genutzt wird, 
Ziel der Systeme kann die Verkehrsflussoptimierung, eine Verbesserung der Si- 
cherheit oder die kooperative Aufgabenbearbeitung in einem Team sein. 

Arbeiten zu kooperativen Systemen sind häufig eng verknüpft mit der Ent- 
wicklung geeigneter Kommunikationssysteme und Protokolle. Auf die Viel- 
zahl von Arbeiten speziell zur Fahrzeug-Fahrzeug- und Fahrzeug-Infrastruktur- 
Kommunikation wird hier nicht weiter eingegangen. Referenzen auf entsprechen- 
de Ansätze und Projekte finden sich in den nachfolgend zitierten Arbeiten sowie 
in IHartensteinQSI . 



2.2.1 Kommunikationsbasierte Warnsysteme 
2^.1.1 Warnung vor Gefahrenstellen 

Kommunikationsbasierte Systeme können Warnungen vor Gefahren wie Unfall- 
stellen, Pannenfahrzeugen, Staus, Glatteis oder Nebel verbreiten IReichaidt021 
INöcker05l lAdlerOöl IBrenzelQll IDötzer05l ISchul/e05l . Die Gefahr wird von den 



Sensoren eines Fahrzeugs erkannt und über Fahrzeug-Fahrzeug-Kommunikation 
den Fahrzeugen in der Umgebung mitgeteilt. Die Fahrer erhalten dann einen ent- 
sprechenden Warnhinweis. Kommunizierende Fahrzeuge werden als Zwischensta- 
tionen für die Weiterverbreitung der Information genutzt (YangQ4| . Alternativ sind 
auch infrastrukturbasierte Warnsysteme denkbar IN ak am ura941 ITo u im i ne tü 8 1 . 



2.2.1.2 KoUisions warnsysteme 



Von verschiedenen Forschungsgruppen wurden kooperative Assistenzsysteme un- 
tersucht, die den Fahrer vor Auffahr-, Kreuzungs- und Abbiegeunfällen war- 



nen IMisenei05l 
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Magcs()9). Die Systeme basieren auf der Kommunikation von Positionsdaten aus 
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Satellitcnnavitiationssv-stemen an andere Fahrzeuue. Zur Abschät/.unü der Kollisi- 



onsgefahr werden häufig die in Abschnitt 2.1 .5 beschriebenen Prädiklionsverfah 



ren eingesetzt. Warnungen werden auf Grundlage der verbleibenden Zeil bis zu 
einer drohenden Kollision generiert. Eine weitere Anwendung ist die Warnung vor 
Kollisionen bei Spurwechsel manch'em |Ammoun()7llRobinson07| . 

Im Luftverkehr ist schon seit Jahrzehnten das Traffic Alert and Collision Avoid- 
ance System (TCAS) im Einsatz IWilliamson89| . Dieses kommunikationsbasierte 
System kann eine drohende Kollision zweier Flugzeuge erkennen. Die verbleiben- 
de Zeit bis zur Kollision dient als Kriterium für die Warnung der Piloten. Zusätz- 
lich kann TCAS auch Handlungsanweisungen geben, die über Funkkommunikati- 
on abgestimmt werden. Eines der beteiligten F'lugzeuge wird gemäß einem regel- 
basierten Entscheidungskriterium zum Sinken, das andere zum Steigen aufgefor- 
dert. Das System wurde formal analysiert und verifiziert llSchroer84llLivadas00l . 



Dennoch konnte TCAS nicht alle Unfälle verhindern. Dies wird insbesondere 
auf Probleme bei der Mensch-Maschine-Interaktion zurückgeführt, es gibt je- 
doch auch Kritikpunkte bezüglich des technischen Funktionsprinzips |Ladkin041 
WeyerQ6b| . 



2.2.2 Kooperative Wahrnehmung 

Fahrzeug-Fahrzeug-Kommunikation kann genutzt werden, um die sensoriellen 
Wahrnehmungen mehrerer kognitiver Automobile miteinander abzugleichen. Da- 
durch kann die Zuverlässigkeit der Wahrnehmung verbessert, das Rauschen ver- 
kleinert und das Gesichtsfeld vergrößert werden. Ferner ist es möglich, Objekte 
zu erfassen, die für das eigene Fahrzeug durch andere Objekte oder aufgrund des 
Straßenverlaufs verdeckt sind. 

Die kooperative Wahrnehmung kann als Problem der Infomiationsfusion aufge- 
fasst werden. Zunächst stellt sich das Assoziationsproblcm: Sind die Wahrnch- 
mungsdaten aus verschiedenen Fahrzeugen demselben realen Objekt zuzuordnen? 
Anschließend ergibt sich durch die Fusion der verschiedenen Informationsquellen 
eine gemeinsame Umgebungsbeschreibung. Wenn die Unsicherheiten der Wahr- 
nehmungsdaten berücksichtigt werden, kann der Fusionsschritt genauere und zu- 
verlässigere Umgcbungsinfomiation liefern. Unterschiedliche Aufnahmczeitpunk- 
te der Sensoren und Latenzen durch die Kommunikalion erschweren die Verarbei- 
tung zusätzlich IIKais()5l . 

Die meisten Arbeiten zur kooperativen W^ahrnehmung im Straßenverkehr be- 
schäftigen sich mit der Fusion der Information aus ohjekterkcnnenden Senso- 
ren. Zur Assoziation und Fusion werden unter anderem Kaiman-Filter BKaramOöl 
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Wciidcrd?] . Interacting Multiple Model Filter (HÜän^Ö^, Joiiu Probabilistic Da- 
ta Association |Tischlei05l und Probabilily Ilypoihesis Density Filier iKriise 101 
eingesetzt. Ein weiterer Ansatz berücksichtigt zusätzlich die hiformation, dass 
an einem bestimmten Ort von einem Sensor kein Objekt wahrgenommen wurde 
|TischlerM7| . Seihst bei Fahrzeugen ohne objekterkennende Sensoren lässt sich 
durch Fusion der Positionsdaten aus Satellitennavigationssystemen eine verbes- 
serte Lokalisierung erreichen iDaoOSbU . 

Die Ergebnisse der kooperativen Wahrnehmung können zur Verhaltensentschei- 
dung für autonome Fahrzeuge und Fahrerassistenzsysteme verwendet werden. 
Beispielsweise kann die ACX'-Funktionalität verbessert und erweitert werden 
iCiiraid 

Einen l 'berblick über weitere Ar- 



TT] |vAivni(>6] Naranjo()6] . Eine weitere Anwendung sind 
Kreuzungsszenarien j bo u r ao u i( ) 6 1 1 N ara n J o 0 7 1 . 



beiten auf dem (iebiet der kooperativen Wahrnehmung geben iDemnicllOI und 
IFuchsOOn . 



2.2.3 Kooperative Fahrnianöver 

Die Idee, kooperative Fahrmanöver zur Verbesserung von Verkehrsfluss und Si- 
cherheit einzusei/on. wird spätestens seit dem Prometheus-Programm verfolgt 
lbraess95||l len iw ichO II . Von ||.l udaschke04| wurde ein Konzept zur Kooperation 



erarbeitet, das die Anpassung der Einzelfahrzeugmanöver zweier kooperierender 
Fahrzeuge beinhallet. Dabei wird für jedes Einzelfahrzeugmanöver entweder die 
Ausführungsgeschwindigkeit oder die laterale Abweichung von der Solltraiektorie 
variiert. Durch Diskretisierung ergibt sich eine Menge von Koordinalionsallerna- 
liven, aus der die kollisionsfreie Kombination mit minimalem Energieverbrauch 
ausgewählt wird. 

Neuere Arbeiten setzen kooperative Fahrmanöver vorwiegend zur Verkehrsfluss- 
optimierung an Kreuzungen ein. Anstelle einer herkömmlichen Verkehrsrege- 
lung mit Ampeln kann die Vorfahrlsreihenfolge zwischen den kooperativen Fahr- 
zeugen über Funkkommunikation vereinbart werden. Mittels dynamischer Pro- 
grammierung können die Geschwindigkeiten für eine kollisionsfreie kooperative 
Kreuzungsüberquerung bestimmt werden ÜBrunsO^j . Die zeitoptimale Reihenfol- 
ge der Kreuzungsüberquerung kann mit Hilfe einer Baumstruktur berechnet wer- 
den IlLiOöl . In lll-i()7l wird ein ähnliches Verfahren für ein Einfädclszenario auf 
einer Autobahn eingesetzt. 

Ein Demonstrator für kooperativ abgestimmte Fahrmaniner ist in ||Baher0511 be- 
schrieben. Mit Hilfe von Modellfahrzeugen wird in | Sheng()6") ein infrastrukturba- 



siertes Verfahren zur Koordination an Kreuzungen getestet. 
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2.2.3.1 Fahr/eugkonvois 

Umfangreiche Forschungsprogramme haben die Automatisiening des Autobahn- 
verkehrs untersucht, allen voran das Projekt California PATH in den USA 
llShladovcr06l . Hin wesentlicher Bestandteil dieser Projekte sind Fahrzeugkon- 
vois (Platoons), in denen mehrere Fahrzeuge vollautomatisch einem Führungs- 
lahrzeug folgen (Varaiya93) . Verglichen mit menschlichen Fahrern verfügt die 
kommunikationsunterstützte Längsregelung über deutlich kürzere Reaktionszei- 
ten. Dadurch können die Abstände zwischen den Fahrzeugen deudich reduziert 
werden |Maschuw()8l |TomlinO(jl , sodass Konvois eine höhere StraBenkapazität 
und infolge von Windschatteneffekten einen geringeren Energieverbrauch errei- 
chen lDao08al SavelsbergO.S) . Die Forschung konzentriert sich vorwiegend auf 



kommunikations- und regelungstechnische Aspekte des Konvoifahrens. Manöver 
zur Konvoibildung und -autlösung ki^nnen ebenfalls mit regelungstechnischcn Me- 
thoden durchgeführt werden |Ra)amani()() lKato02l . 



2.2.4 Infrastrukturbasierte Verkehrsflussoptimieruiig 

Die infrastrukturgestützte Verkehrsflussoprimierung wird schon seit mehreren 
.lahrzehnten erforscht, insbesondere für Autobahnen |Papageor giou83[[BäskärÖ8l. 



Durch eine Regelung des einfahrenden Verkehrs soll die Überschreitung der Ka- 
pazität der Autobahn verhindert werden. Eine Anwendung im Stadtverkehr ist 
die Geschwindigkeitsregelung in Abhängigkeit von der aktuellen Ampel phase 
llMandava()9| . 

Die Staubildung und -auflösung wird von verschiedenen konkurrierenden Ver- 
kehrsfiusstheorien modelliert jl lelbing'JT |Kerncr()4| , aus denen sich Maßnahmen 



zur kommunikalionsbasierten Stauvermeidung ableiten lassen IKernerOSI . 

2.2.5 Kooperationsmechanisnien aus der Robotik 
2.2.5.1 Schwarinverhaitcn 

Biologisch motivierte Ansätze steuern kooperierende Roboter in Anlehnung 
an das Verhalten von Schwärmen in der Natur |Ca(^97| . Mit einfachen loka- 
len Regeln kann ein komplexes Verhalten des Schwarms bewirkt werden, bei- 
spielsweise das Einnehmen einer Formation oder die Aufteilung auf mehre- 
re Zielpunkte (Sugihara90| |Chen941 IPirjanianGÜl IGoehelsü5l IMolnärül! lReit^)9| 



Kowalczyk()4|. Verwandte Methoden werden in der verhaltensbasierten Robotik 



emüesetzt IArkin98UHunLsber2erü3l 
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2 Stand der Forschung 



Eine weitere M(i»;lichkeit ist die Zusammenfassung von Robotern /u festen 
(Iruppen und anschließende Verhaltensenischeidung auf der Abstraktionsebe- 
ne der Gruppe ohne individuelle Betrachtung der einzehien Roboter lReiP)9l 
Kamphuis()4| lBclta04| . 



2.2.5.2 Kooperative Regelung 

Das Problem der kooperativen Regelung einer Formation mehrerer Roboter stellt 
sich beispielsweise für (iberwachungsaufgaben. Häufig werden die Formations- 



milglieder relativ zu einem FHihrungsfahrzeug geregell |()gren()3 |lMorelli().S]| . Die 



Relationen zwischen Führungs- und Folgefahrzeugen können in einem (Iraphen 
repräsentiert werden |Raillieul07| . Untersucht wird die Hindemisvermeidung und 
das Wechseln zwischen verschiedenen Formationen iMun av07| |Desai^J9l . Meist 



wird von großen Abständen zwischen den Formationsmitgliedern ausgegangen, 
sodass die Vermeidung von Kollisionen zwischen den kooperierenden Robotern 
nur in wenigen Arbeilen behandelt wird ]Dimarogonas07 lLian02lfl"'eddema()2l . 

Mit regelungs- und graphentheoretischen Methoden kann auch das Problem 
der gemeinsamen Entscheidungsfindung in einer Gruppe adressiert werden 
l Olfati-SaberTT/l . Konsens- AI uorithmcn k()nnen in einfachen Anwendungen die 
Konsistenz der verteilten Wahrnehmung in einem vScnsomctz sicherstellen. Außer- 
dem kann ein gemeinsamer Treffpunkt für eine Gruppe von Robotern verteilt be- 
rechnet werden (Rendezvous-Problem). 



2.2.5.3 Aufgabenplanung in Teams und Verhandlungen zwischen Agenten 

Eine weitere Form der Kooperation ist die gemeinsame Bearbeitung einer Auf- 
gabe in einem Team mehrerer Agenten. Die Agenten können Roboter, auto- 
nome Fahrzeuge oder reine Software-Agenten sein liWeiss99l |W(H>ldridge9.S 



Dudek96| . Die Aufgabenplanung umfasst die Zuweisung von Rollen, die Pla- 
nung der Teilaufgaben für die einzelnen Agenten unter Berücksichtigung ih- 
rer ieweiliiicn Fähisikeiten sowie Maßnahmen zur fehlcrtoleranten Ausführuna 
| Norcils92[ |Pynadath()2] |W(H)ldridgc99] |I.afrcnz()7| iLcviOril |Brumitt98l . Typi- 
sche Anwendungen sind Roboterfußball, kooperative Exploration und militäri- 
sche Aufgaben llNebel()2[|Zlot021|Burgard()S[|Kress-Gazit()91|Tambc()()|l . Bei mo- 
bilen Robotern und autonomen Fahrzeugen kann die Zuordnung von Transport- 
aufträgen zu Fahrzeugen als Problem der Aufgabenplanung angesehen werden 
I A 1 am 1 02111ns a(;orrea051 IM c 1 k lü 81 . 



Die Zuordnung der Teilaufgaben zu Agenten kann in Verhandlungen festge- 
legt werden IWciss99| |Roscnschein94j [Wo(^ldridge99| . Ein anderes Szenario für 
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Verhandlungen ist die nachträgliche Auflösung von Konflikten zwischen meh- 
reren Agenten |Martial92| |(Mui-(\trroll96l Wangermann99| . Zunächst erstellt je- 
der Agent einen individuellen Plan. Im Fall von Konflikten zwischen den Plä- 
nen wird verteilt ausgehandelt, welche Anpassungen vorzunehmen sind. Anwen- 
dungen im Straßenverkehr sind das verteilte Aushandeln der Vorfahrt an Kreu- 
zungen und die Koordination von Spurwcchsehnanövern an Autobahnauffahrten 
llRausch95l|Schepperle()7llBourochefl6llMorla051. 



2.2.6 Gruppenbildung 

Mit der Zusammenfassung von Agenten zu Gruppen können verschiedene Ziel- 
setzungen verfolgt werden. Häufig werden Gruppen zur vStruklurierung des Kom- 
munikationsnelzwerks gebildet, um Zuverlässigkeil und Durchsatz der IJbertra- 
gung zu erhöhen I S h i m u r a(T3l I M u n ak a( ) 5 II M i 1 1 e r 0 8 II . Dies ist von anwendungsbe- 



zogenen Kriterien zur Gruppenhildung zu unterscheiden; beide Gruppenstrukturen 
können gleichzeitig nebeneinander bestehen |Fujii99| . Viele Arbeiten zu koopera- 
tiven Systemen verzichten jedoch auf eine e.\plizite anwendungsbezogene Grup- 
penbildung und betrachten alle Fahrzeuge innerhalb der Kommunikationsreich- 
weite als Gruppenmitglieder llClark(.)41ITanU6l . 

Bei kooperativen Systemen zur Verkehrsflussoptimierung werden häufig alle Fahr- 
zeuge zu einer Gruppe zusammengefasst, die sich in einem vorab festgelegten 
Bereich des Straßennetzes befinden, etwa auf einer bestimmten Kreuzung oder 
einem Autobahnab.schnitt lLiü6l[Däo08a|[Zhouü7||MeierO 1 1 . Ein anderer Ansatz 



ist die Erkennung potenzieller Konflikte zwischen allen Fahrzeugen und die an- 
schließende Bildung von Gruppen aus zueinander in Konflikt stehenden Fahrzeu- 
gen |Judaschke94| Chiang97] Leroy99 Sheng06 |Branca061 . Zur Gruppenbildung 



für kommunikationsbasiertc Sicherheitssysteme werden in IChisalita07| schwcll- 
wertbasierte Kriterien beschrieben, die unter anderem die räumliche Ausdehnung 
und die Anzahl der Mitglieder einer Gruppe berücksichtigen. Bei der Bildung von 
Fahrzeugkonvois sind Kriterien wie Fahrtziel und Wunschgeschwindigkeit rele- 
vant lKhan05l . Mit geometrischen Dberlegungen können Roboter mit gleicher 
Fahrtroute zu Gruppen zusammengefasst werden, um die Bewcgungsplanung zu 
vereinfachen |Li()3| . 

Ein weiterer Forschungsschwerpunkt sind Protokolle zur Verwaltung der Grup- 
penmitgliedschaft INett03l lBottazziÖ5l iBriesemeisterOll . Häufig werden die- 
se Verwaltungsaufgaben von einem Führungsfahrzeug übernommen IZhouü71 
Huang04| . 
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2 Stand der Forschung 



Ein zur Gruppcnbildung verwandtes Problem in der kooperativen Spieltheorie ist 
die Berechnung von Koalitionen, die bezüglich einer Bewerlungsfunklion optimal 
sind lSandholm981|Shchory96| . 



2.3 Bahn- und Bewegungsplanung 

Die Planung kooperativer Fahrmanöver kann als Problem der Bewegungsplanung 
für mehrere Roboter aufgefasst werden, wobei die Fahrzeuge spezielle Roboter 



sind. Diese Betrachtungsweise bildet die Grundlage für die in Kapitel 5 der vor- 
liegenden Arbeit beschriebenen Planungsalgorithmcn. Daher wird in diesem Ab- 
schnitt der vStand der Forschung auf dem Gebiet der Bahn- und Bewegungspla- 
nung skizziert. Bei der Bahnplanung wird ein Weg des Roboters von einer Start- 
zu einer Zielposition gesucht, der Kollisionen mit Hindernissen vermeidet. Bewe- 
gungsplanung berücksichtigt zusätzlich den zeitlichen Verlauf und die Dynamik 
des Roboters (vgl. Kapitel 5~f} . 



Im Folgenden werden zunächst einige theoretische Resultate zur Problemkomple- 
xität erwähnt. Anschließend wird kurz auf verbreitete Planunesaleorilhmen aus der 



Robotik eingegangen. Abschnitt 2.3.3 schildert den Stand der Forschung bei spe- 
ziell auf den Einsatz in Fahrzeugen zugeschnittenen Planungsalgorithmen. Danach 
konzentriert sich die Darstellung auf die Bewegungsplanung für mehrere Roboter 
bzw. Fahrzeuge. Dabei sind die beiden folgenden Ansätze zu unterscheiden: ko- 
operative Bewegungsplanung im gemeinsamen Konhgurationsraum und Entkopp- 
lung in mehrere Teilprohlcme. 



2.3.1 Komplexität des Bcwcgungsplanungsproblcms 

In diesem Abschnitt wird auf theoretische Resultate zur Komplexität des Bcwc- 
gungsplanungsproblcms eingegangen, die auch für die Planung kooperativer Fahr- 
manöver relevant sind. Eine Zusammenstellung von Komplexitätsresultaten findet 
man in ILaValleOöi Kapitel 6.5] und in ILatombe91l Kapitel 1.6]. 

Zunächst wurde von lReif79| und | (\inny88") gezeigt, dass ein allgemeines Bahn- 



planungsproblem ohne Berücksichtigung der Dynamik PSPAGE-voUständig istQ 
Die Bewegungsplanung für ein Objekt mit beschränkter Geschwindigkeit bei be- 
wegten Hindernissen ist ebenfalls PSPACE-schwer lReil'851 . Hinsichtlich der ko- 
operativen Bahnplanung bewies (Hopcrofi84] . dass bereits die Planung kollisions- 

' Da die Pioblc'inkliisse NP in PSPAC C enthalten ist. folgt daraus, dass das Problem NP-schwer ist. 
Eine Einführung in die Theorie der Koniple,\itätsklassen findet man in (SipserDo] sowie in IChoset05l 



Anhang G] 
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freier Bahnen für mehrere rechteckige Objekte, die sich lediglich translatorisch in 
der libene beweaen können. PSPAC'li-schwer ist. 

Die Anzahl der Freiheilsgrade des Roboiersystenis gehl wesentlich in die Länge 
der Aiifgabenspezifikalion ein. die der Bestimmung der Kompiexilatsklasse zu- 
grunde liegt. Da die Anzahl der I-reiheitsgradij^ linear mit der Anzahl der koope- 
rierenden Fahrzeuge wächst, ist die kooperative Bewcgungsplanung ein deutlich 
schwierigeres Problem als die Finzellahrzeugplanung. Im Allgemeinen steigt die 
Rechenkomplexilät exponeniiell mit der Anzahl der Fahrzeuge |Latombe911 Ab- 
schnitte 1 .6 und 8.2.2]. Viele Algorithmen, die für Einzelfahrzeuge eingesetzt wer- 
den, lassen sich daher nicht effizient auf das kooperative Problem anwenden. Auf- 
grund der hohen Problemkomplexität werden zur Bewegungsplanung i.d. R. sub- 
optimale heuristische Algorithmen eingesetzt, die nicht jede formulierbare Pla- 
nungsaufgabe lösen können iLaValleQ6l . 



2.3.2 Bahnplanungsalgorithmcn aus der Robotik 

In diesem Abschnitt wird kurz auf einige verbreitete, allgemein einsetzba- 
re Bahnplanungsalgorilhmen eingegangen. (lenaueres kann den Lehrbüchern 
| Lalombc9niChosct0^1lLaVallc06ll entnommen werden. 



Vollständige Algorithmen können jedes Problem lösen, für das eine kollisions- 
frcie Bahn existiert. Zu den vollständiüen Algorithmen iiehört die exakte Zellen- 
Zerlegung. Sie bildet zunächst die Geometrie der Hindernisse in den KonHgura- 
lionsraum ab, der die möglichen Bewegungen des Roboters entlang seiner Frei- 
heilsgrade charakterisiert. Mil Hilfe einer geometrischen Zerlegung des Konfigu- 
rationsraums in z. B. konvexe Regionen lässt sich das Bahnplanungsproblem an- 
schließend auf zwei Teilprobleme reduzieren: Die lokale Bahnplanung innerhalb 
einer Region und die globale Planung im Zusammenhangsgraphen der Regio- 
nen. Letzleres kann mil einem (iraphensuchalgorithmus wie etwa der A*-Suche 
lHart68lfRussell03l gelöst werden. Eine andere Möglichkeit ist die Dimensionsre- 
duktion durch wiederholte Projekdon des Raums entlang einer Achse. Dies wird 
bei den Silhouetten-Algorithmen und beim Algorithmus von Canny eingesetzt 
|(\nmyS8") . Retraklionsverfahren beschränken die Suche auf Bahnsegmente mit 
maximaler Enifernung von Hindernissen, wie verallgemeinerte Voronoi-Diagram- 
me Irhoset05l Kapitel 5]. Den vollständigen Algorithmen ist gemeinsam, dass sie 
wegen der zahlreichen geometrischen Sonderfälle nur schwer zu implementieren 
sind und dass ihr Rechen- und Speicheraufwand mit der Anzahl der Fieiheitsgrade 
stark ansteigt lLaValle06l . 



-vgl. hierzu den Begriff des Konfigurationsraums, der in 



Kapitel 5. 1 



eingeführt wird. 
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2 Stand der Forschung 



Einfacher zu implementieren ist die approximative Zellenzerlegung, die den Kon- 
figuralionsraum beispielsweise durch ein regelmäßiges Gitter repräsentiert. Für je- 
de Gitterzelle kann fesigestelit werden, ob sie einer Hindernisregion angehört oder 
nicht. Der Graph der hindcrnisfrcicn Zeilen kann wiederum vom A*-Algorithmus 
nach dem kürzesten Weg auf dem Gitter durchsucht werden. Aufgrund des vSpei- 
cheraufwands dieser Verfahren ist nur eine begrenzte Anzahl Freiheitsgrade hand- 
habbar. Abschwächen lässt sich diese Problematik durch hierarchische Gilter, die 
schrittweise verfeinert werden IHein03l . 

Auf heuristischen Analogien basieren die Potenzialfeldverfahren. Mit jedem Hin- 
dernis wird ein abstoßendes Potenzial assoziiert. Der Roboter bewegt sich in ne- 
gativer Gradientenrichtung zu einem Minimum des Potenzials. Problematisch ist, 
dass er einem lokalen Minimum nicht ohne weiteres entkommen kann. Ein Po- 
tenzialfeld mit genau einem lokalen Minimum wird als Navigationsfunktion be- 
zeichnet |Rim(Mi92t Damit kann die Problematik der lokalen Minima vermieden 
werden, allerdings ist die Konstruktion einer Navigationsfunktion deutlich auf- 
wändiger: Da sie die Li)sung des Bahnplanungsproblems bereits unmittelbar co- 
diert, gelten für ihre Berechnung im allgemeinen Fall die Komplexitätsresultate 
aus lAbschnitt 2.3. fl 

Ein anderer verbreiteter Ansatz beruht auf der Abtastung des Konfigurationsraums 
an einzelnen Punkten, die üblicherweise zufallsgesteuert gewählt werden. Be- 
nachbarte kollisionsfreie Punkte werden anschließend durch einfache lokale Bah- 
nen verbunden, sodass man einen Graphen erhält, der näherungsweise die To- 
pologie des KonHgurationsraums widerspiegelt. Der kürzeste Weg innerhalb die- 
ses Graphen kann wieder durch A*-Suche berechnet werden. Verschiedene Vari- 
anten dieses Ansatzes sind als Probabilistic Roadmaps (PRM) IKavraki96l und 
Rapidly-Exploring Random Trees (RRT) |LaVallc99l bekannt. Diese Verfahren 
können auch mit einer gnißeren Anzahl Freiheitsgrade umgehen, insbesondere 
wenn der hindernisfreie Raum groß im Verhältnis zur Ausdehnung des Roboters 
ist l(^hoset05l[iVlages07| . 



Die meisten Planungsalgorithmen vernachlässigen, dass sowohl die Modelle von 
Umgebung und Roboter als auch die Ausführung von Handlungen mit Unsicher- 
heiten behaftet sind. Es gibt einige wenige Ansätze zur Berücksichtigung von pro- 
babilistisch modellierten Unsicherheiten |Fraichard981IMclchior(j7irroussaint07| . 
Eine solche Planung kann unter anderem das Ziel haben, die Lokalisierungsunsi- 
cherheit zu begrenzen ILambertQ3IIGonzalez07l . 



2.3 Bahn- und Bewegungsplanung 



21 



2.3.3 Bahn- und Bcwcgungsplanung für Einzclfahrzcugc 

Bei der Anwendung auf Straßenfahrzeuge sind folgende Besonderheiten zu nen- 
nen, die entsprechende Anpassungen der Planungsalgorithmcn erforderlich ma- 
chen: 

• Fahrzeuge können sich nicht in beliebige Richtungen bewegen, sondern sind 
durch ihre nichtholonome Kinematik eingeschränkt (vgl. [Abschnitt 5.3.2) . 
Die Nichlholonomie eines Systems lässt sich mit Hilfe von Lie-Ableilun- 
gen mathematisch charakterisieren IISoiieres98l . Bei der Planung von Ran- 
giermanövern für Fahrzeuge ist es möglich, zunächst mit einem holonomen 
Modell zu planen und anschließend in einem weiteren Verarbeitungsschritt 
die nichihülonomen Beschränkungen durchzusetzen |Launiond98l . 



Während die Dynamik in vielen Robotikanwendungen vernachlässigt wer- 
den kann, spielt sie bei Straßenfahrzeugen aufgrund der höheren Geschwin- 
digkeiten und Massen eine entscheidende Rtillc. 

• Andere Verkehrsteilnehmer stellen bewegte, nicht beeinflussbare Hindernis- 
se dar, die bei der Planung berücksichtigt werden müssen. 

Das bereits erwähnte RRT-Vcrfahren und verwandte probabilistische Algorith- 
men wurden im Hinblick auf die Berücksichtigung von kinematischen und dy- 
namischen Beschränkungen entworfen und eignen sich daher auch für Fahrzeuge 

lll.aValle9Q|[rr:iIü2lfr7m^^ 

Gitterbasierte Verfahren werden ebenfalls eingesetzt, insbesondere in Verbindung 
mit einer gitterbasierten Repräsentation der wahrgenommenen Fahrzeugumge- 
bung ]Ziegler()8ä| LSchreklerÖ^] |Stahn07| . Zu beachten ist, dass die Gitterpunkte 



aufgrund der kinematischen Beschränkungen im Allgemeinen nicht exakt erreicht 
werden können. Daher muss entweder eine entsprechende Korrektur durchgeführt 
oder ein speziell angepasstesGitter verwendet werden iMontcniL-rloOSl Zi"c^lcr()9| . 



Bei der A*-Suche im Graphen wird meist nicht der euklidische Abstand als untere 
Schranke verwendet, sondern eine Metrik, welche die nichtholonome Kinematik 
berücksichligl, /. B. die Länge der Duhins- oder der Reeds-Shepp-Kurve bis zum 
Zielpunkt ISoueres981ILaValle()6l |Zit;gler()8a[. Um die geplante Bahn inkremen- 



tell an eine aktualisierte Umgebungswahrnehmung anzupassen, können Verfahren 
wie der D*-Algorithmus zur Graphensuchc eingesetzt werden, der eine komplette 
Neuplanung vermeidet lStentz9.5||LikhachevQ5l . 

Im Straßenverkehr werden häufig Entscheidungsverfahren verwendet, die ledig- 
lich die aktuell durchzuführende Handlung bestimmen, ohne einen Plan für wei- 
tere Handlungen zu erstellen. Diese Verfahren sind typischerweise recht schnell 
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2 Stand der Forschung 



und können mit einer vergleichsweise hohen Frequenz iterariv angewendet wer- 
den. Die resultierenden Entscheidungen können direkt in Form von Steuergrö- 
ßen für den Fahrzeugregler ausgedrückt werden |vl lunJcishause 
IRescndcfUl . Auf diese Weise kann ein glatter Verlauf der Fahrzeugbewegung si- 
chergestellt werden. Eine andere Möglichkeit ist die Paramctrierung über den la- 
teralen Versatz relativ zur Fahrspur lürmsonOSI IMontemerloOSI . Entscheidungs- 
kriterien können auch im Raum der Geschwindigkeitsvektoren formuliert werden 
IFiorini981 Large04| lKunwar06l . Ein zweistufiges Entscheidungs verfahren wird 
in IBroggiloj beschrieben. Eine weitere Möglichkeit ist die Anpassung der Para- 
meter vorgegebener Bahn- oder Bewegungsverläufe, die z. B, einen Spurwechsel 
modellieren, an die aktuelle Situation llsermann081lKirchner05l[LiÖ7l . 

Die Methode der elastischen Bänder |Quinlan93] kann als Weiterentwicklung der 
Potenzialfeldverfahren aufgefasst werden. Die vom Potenzial induzierten Kräf- 
te wirken nicht nur lokal auf die Bewegung des Roboters, sondern breiten sich 
entlang des geplanten Weges aus. Dadurch wird eine approximative Berück- 
sichtigung der Dynamik und eine Bcwcgungsplanung für Fahrzeuge möglich 
|1 lilgert03] |Biandt()5h| . Die Methode der elastischen Bänder wird in verschiede- 
nen Varianten von mehreren Forschungsgruppen zur Bewegungplanung für Einzel- 
fahrzeuge eingesetzt IHesseOTal IGehrigOT) IWillelQl IKatriniokl II . Ein ähnlicher 
Ansatz wird in |Ha.s.soun92| verwendet. 

Insbesondere bei vollständig autonomen Fahrzeugen muss gewährleistet werden, 
dass die gewählte Bewegung nicht in einen Zustand führt, in dem ein Unfall nicht 
mehr zu vermeiden ist. Ein Schema der iterierten Planung und Ausführung, das 
solche Sicherheitsgarantien geben kann, ist unter der Bezeichnung Partial Motion 
Planner bekannt IPetti05l[BouraouiQ6llMacekQ8l IResendelOI . Eine hinreichende 
Bedingung für die Sicherheit eines Zustands ist die kollisionsfreie Ausführbarkeit 
eines Notfallmanövers |Bckns07a| . Für die eigentliche Bewegungsplanung wer- 
den bei diesem Verfahren meist RRTs eingesetzt. 



2.3.4 Entkoppelte Bewegungsplanung für mehrere Roboter 

Angesichts der hohen Komplexität der kooperativen Bcwcgungsplanung werden 
häufig Verfahren eingesetzt, die das Problem auf mehrere Planungsschritte mit 
einer geringeren Anzahl an Freiheitsgraden reduzieren. Diese Verfahren zur Ent- 
kopplung des Problems in mehrere Teilaufgaben können als Stand der Technik für 
die Bewegungsplanung für mehrere Roboter gelten ILaVal1e061 Kapitel 7.2]. Zwei 
verbreitete Verfahren zur entkoppelten Planung werden im Folgenden beschrieben. 

Die Entkopplungsverfahren schränken die Vollständigkeit des Planers ein, d.h. 
die Verfahren können nicht den gesamten kooperativen Handlungsspiclraum aus- 
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□3 



so 



(a) 



(b) 



(c) 



(d) 



Abbildung 2.1: Vergleich verschiedener Ansätze zur Bewegungsplanung in einem 
Gegenverkehrsszenario mit zwei Fahrzeugen. Bremsmanöver sind mit roter Farbe 
markiert. 



(anAnfaneszustand, 



(b) Entkopplung von Bahn- und Geschwindigkeits- 



planung, [^jprioritätsbasierte Planung, |(d)] kooperative Bewegungspianung im ge- 
meinsamen Konfigurationsraum. 



schöpfen IChoset051 Abschnitt 7.5.2]. In IILatombe9l| Abschnitt 8.2] ist ein Bei- 
spiel zweier Roboter in einem schmalen Kt)rridor angegeben, das von den Ent- 



kopplungsvcrt'ahren nicht gelöst werden kann. [Abbildung 27r| vcrdcutlicht die Ein- 
schränkungen des Lösungsraums an einem einlachen Szenario aus dem Straßen- 
verkehr. Die UnVollständigkeit zeigt sich auch beim experimentellen Vergleichen 
zwischen entkoppelter Planung und kooperativer Planung im gemeinsamen Kon- 
figurationsraum ISänchezü2[|Zeghal98) . 



2.3.4.1 Entkoppelte Bahn- und Geschv^indigkeitsplanung 



Die Entkopplung von Bahn- und Geschwindigkeitsplanung geht auf llKant86l 
zurück. Im ersten Schritt des Verfahrens wird eine rein geometrische Bahnpla- 
nung durchgeführt, die Ausführungsgeschwindigkeit und Dynamik unberücksich- 
tigt lässt. Im zweiten Schritt wird die Auslührungsgeschwindigkeit entlang der 
zuvor festgelegten Bahn geplant. 

Bei der Planung für mehrere Roboter wird zunächst für jeden Roboter separat 
eine Bahn geplant, die Kollisionen mit stationären Hindernissen vermeidet. Die 
anderen Roboter werden dabei ignoriert. Anschließend werden die Ausführungs- 
geschwindigkeiten so koordiniert, dass keine Kollisionen zwischen den Robo- 
tern auftreten |()'Donnell891|Lcroy09|rGuoQ21|Shin8ÖllGhrist()5l|Peng05| . Zu die- 
sem Zweck kann das Koordinationsdiagramm verwendet werden, dessen Achsen 
den Ausfuhrungszeiten der einzelnen Roboterbahnen entsprechen. Der beste Weg 
kann im Koordinationsdiagramm bcispielswei.se mit einer geeignet angepassten 
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Variante der dynamischen Programmierung oder der A*-Suche gefunden werden 
IlLecQ.S I [SlrübeÖnl [HrwÖÖ) . 

In einigen Arbeilen ist auch die Ausriihrungsgeschwindigkeil der einzehien Ro- 
bolerbewegungen fest vorgegeben, und die Koordination beschränkt sich auf die 
Verschiebung der Anfangszeitpunkte der Bewegungen lAkeUa()2M . 

Neben dem Verlust der Vollständigkeit durch das Ignorieren der anderen Roboter 
im ersten Schritt des Verfahrens bringt die verwendete Entkopplungsannahme zu- 
sätzlich das Problem mit sich, dass die Dynamik der Roboter nur eingeschränkt 
berücksichtigt werden kann. 



23A2 Prioritätsbasicrtc Planung 

Ein weiteres Verfahren zur Bewegungsplanung für mehrere Roboter ist die priori- 
tätsbasierte Planung IIErdmann87l . Zunächst wird eine Prioritätsreihenfolge unter 
den Robotern festgelegt. Anschließend wird die Bcwcgungsplanung für jeden Ro- 
boter separat in der Reihenfolge der Prioritäten durchgeführt, beginnend mit der 
höchsten Priorität. Bei der Planuns für einen bestimmten Roboter sind die Pläne 
für alle Roboter mit höherer Priorität bereits bekannt. Ihre geplanten Bewegungen 
können als bewegte Hindernisse berücksichtigt werden. Die Roboter mit niedrige- 
rer Priorität werden zunächst ignoriert. Diese Roboter müssen anschließend versu- 
chen, einen Bewegungsplan zu (inden, der Kollisionen mit den Robotern höherer 
Priorität vermeidet. 

Das Planungsergebnis hängt von der gewählten Prioritätsreihenfolge ab. Daher 
wurden in der Literatur Heuristiken und Optimierungsverfahren zur Wahl der Prio- 
ritäten untersucht |Buckley8^)] |vdBerg()5[ IBcnnewit/()41 |Regele06| Iriark02l . Das 



Verfahren kann jedoch .selbst bei optimaler Prioritätsreihenlolge nicht den vol- 
len kooperativen Ilandlungsspielraum ausschöpfen und ist somit unvollständig. Im 
Unterschied zur Entkopplung von Bahn- und (leschwindigkeitsplanung kann eine 
Bewegungsplanung unter Berücksichtigung der Dynamik durchgeführt werden. 

Für die einzelnen Bewegungsplanungsprobleme im Rahmen eines prioritätsbasier- 
ten Ansatzes kommen verschiedene Algorithmen in Frage, z. B. Graphensuche auf 
einem diskreten Gitter |Azarm96l IBennew i t/04| , Potenzialfelder ||Warrcn90| oder 



Probabilistic Roadmap Verfahren |vdBcrg()?| . Der Einsatz von RRTs nach dem 
Konzept des Partial Motion Planncrs wird in lBckris()7bl beschrieben (vgl. |Ab- 



schnitt 2.3.3 i. In |Freund88l werden vorgegebene parametrisierte Ausweichstrate- 
gien für den Roboter mit niedrigerer Priorität verwendet. In ||Chun'j9| weicht der 
Roboter mit niedrigerer Priorität zu einem Zwischenziclpunkt aus, der in Abhän- 
gigkeit der Roboterpositionen erzeugt wird. Die Anwendbarkeit der prioritätsba- 
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sicrten Planung im Luftverkehr wurde ebenfalls untersucht, wobei sämtliche Prio- 
ritätsreihenfolgen ausgewertet wurden (ChiangOT) . 



2.3.5 Kooperative Bewegungsplanung für mehrere Roboter 

In diesem Abschnitt werden Planungsverfahren vorgestellt, die auf Entkopplungs- 
annahmen verzichten und somit einen größeren kooperativen Mandlungsspiclraum 
ausschöpfen können. Zunächst wird auf einfache Entscheidungsverfahren ohne 
Vorausplanung eingegangen, anschließend auf die Planung im gemeinsamen Kon- 
figurationsraum und speziell auf die gemischt-ganzzahlige lineare Programmie- 
rung. 



23.5.1 Entscheidungen ohne Vorausplanung 

Zahlreiche Ansätze für die Steuerung mehrerer Roboter verzichten auf eine Bahn- 
planung im engeren Sinne und entscheiden instantan anhand des aktuellen Zu- 
slands über die nächste auszuführende Handlung. Solche reaktiven Verfahren 
zeichnen sich durch einen geringeren Rechenaufwand und eine gute Anpassungs- 
fähigkeit an veränderliche Umgebungen aus. Allerdings ist es schwierig, die Dy- 
ntunik der Roboter angemessen zu berücksichtigen und glatte, verklcmmungsfreie 
Bewegungen zu erzielen. 

Regein für eine kollisionsvermeidende Wahl der Geschwindigkeitsvektoren wer- 
den u. a. in |Saito891 Kluge04{lMcr79 1 l|Rude95l beschrieben. Kooperative Bewe- 



gungen lassen sich mit abstoßenden und rotatorischen Kräften erzielen, die mit 
Hilfe von Potenzialfeldem konstruiert werden IMasoud')fi| . In eingeschränkten 
Umgebungen ohne stationäre Hindernisse kann eine Navigationsfunklion definiert 
werden |Dimarogonas05a Dimarogc)nasü5b| . Eine weitere Möglichkeit sind Ko- 



operationsverfahren, bei denen entweder die Geschwindigkeit oder die Fahrtrich- 
tung der Roboter zur Kollisionsvermeidung angcpasst wird IPedduri07l . Kollisi- 
onsfreie Richtungen oder Geschwindigkeiten können auch mittels gemischt-ganz- 
zahliger linearer Programmierung berechnet werden IPallottino02l . 

Zur Kollisionsvermeidung von mehreren Flugzeugen kann eine instantane 
Entscheidung über die einzuschlagenden Flugrichtungen getroffen werden 
IlKrozelO 11 . Hierzu können virtuelle Kräfte in Abhängigkeit der Flugzeugposi- 
tionen definiert werden |jZeghal98] |Rand041 |Kosecka^)7l - Mit einem spieltheo- 



retischen Verfahren wurden ebenfalls die zu wählenden Richtungen optimiert 
lArchibaldOBI . Strategien, die im Konfliktfall kreisförmige Bewegungen vorsehen, 
wurden mittels hybrider Automaten modelliert IITomlin98l IPallottino07l . Dabei 
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muss stets genügend Freiiaum reserviert werden, um bei Bedarf die Kreisi^ewe- 
gung durchlühren zu können, üinen Überblick über Ausweichslralegien im Luft- 
verkehr gibt IKucharOOl . 



2.3.5.2 IManiiii^ im gemeinsamen Konfi^urationsraum 



Das Planungsproblem für mehrere Roboter kann im gemeinsamen Konfigurati- 
onsraum formuliert werden, der sich als kartesisches Produkt der einzelnen Kon- 
figuralionsräume ergibt jLatombeQ Ij Abschnitt 8.2], KMiosetO.Sl Abschnitt 7.^.2]. 
Prinzipiell können dann die gleichen Bahn- und Beuegungsplanungsalgorilhmen 

Da 



einaesetzt werden wie bei der Planung für einzelne Roboter (Abschnitt 2.3.2 



ind 



jedoch der Aufwand i.d. R. exponentiell mit der Anzahl der Roboter wächst 
viele Algorithmen nicht mehr praktikabel (vgl. |Abschnitt 2.3.T} . 

Probabilistic Roadmaps wurden atif die Planung im gemeinsamen Konfigurati- 
onsraum mehrerer hidustrieroboter oder mobiler Roboter angewandt llClark03l 
SancheztHl Carpin()2a lBckris()3lllsto()6l I'ergusonOH) . Die beobachteten Rechen- 
zeilen für die jeweiligen Problemstellungen variieren erheblich. 

Ein speziell angepasstes Potcnzialfeldverfahren wird in |Barraquand92| zur Pla- 
nung für mehrere mobile Roboter eingeset zt. Das koo perative Bevvegungspla- 
nungsproblem für mehrere Flugzeuge wird in iinalhan02i durch dezentrale nichtli- 
neare Optimierung und in II Borrel liOOl durch nichtlineare Programmierung gelöst. 
Ein exaktes Zellenzerlegungsverfahren für den gemeinsamen Konfigurationsraum 
mehrerer mobiler Roboter wird in |Parsons9ü| beschrieben. Dynamische Program- 
mierung kann eingesetzt werden, um die Menge der Pareto-optimalen Pläne zu 
berechnen ||LaValle98| . 



2.3.5.3 Geniischt-ganzzahlige lineare Programmierung zur kooperativen 
Bewegungsplanung im Luftverkehr 

Die gemischt-ganzzahlige lineare Programmierung (mixed integer linear pro- 
gramming. MILP) ist ein Verfahren zur Optimierung unter Nebenhcdingungcn 
llSierksma961 . Sowohl die Ziclfunktion als auch die Nebenbedingungen, die von 
der Lösung zu erfüllen sind, müssen linear in den Optimierungsvariablen sein. Die 
Variablen können reellwertig oder ganzzahlig sein. Während lineare Programme 
ohne Ganzzahligkeitsbedingungen effizient gelöst werden können, sind für MILPs 
Algorithmen mit deutlich höhcrem Rechenaufwand erforderlich, wie etwa Branch- 
and-Bound-Suche iSicrksnu 

Mi- 
Einige Arbeiten verwenden eine MTLP -Formulierung zur kooperativen Bewe- 
gungsplanung für mehrere Flugzeuge ISchouwenaarsQ I ||Richards021IBorrelli06l . 
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n 



Die kontinuierlichen Variablen beschreiben die Positionen, Geschwindigkeiten 
und Beschleunigungen der Mugzeuge zu diskreten Zeitpunkten. Verknüpft werden 
sie durch Nebenbedingungen, die linearisierte Zuslandsraummodelle abbilden. Zur 
Modellierung der Kollisionsvermeidung werden ganzzahligc Variable benötigt, die 
festlegen, auf welcher Seite ein Objekt passiert wird. Die Zielfunktion minimiert 
i.d. R. die Beschleunigung oder den Energieverbrauch. 

Der Ansatz wurde auch in anderen Anwendungsbereichen verwendet, etwa für 
mobile Robt)ter |Earl07| . Außerdem wurden die Handlungen zweier FuBballro- 
boter mit Hilfe der gemischt-ganzzahliger Programmierung sowie eines hierarchi- 
schen Automatenmodells geplant BReinlQVl . Die Modellierung kann erweitert wer- 
den, um simultan zur Bewegungsplanung eine Aufgabenplanung zu ermöglichen, 
etwa eine Zuordnung zwischen Robotern und Zielpunkten |Fierroü5l . 

Es gibt auch einen Ansatz, der mit linearer Programmierung ohne ganzzahlige 
Variable auskommt (Niedringhaus95| . In diesem Fall muss die Ausweichrichtung 
vorab von einem externen Entscheidungsverfahren festgelegt werden. Ein ähnli- 
ches Vorgehen wird in IFrazzoliüll zusammen mit semidefiniter Programmierung 
verwendet. 



2.3.6 Koordination in Roadmaps 



Die PRM-Verfahren ( |Abschnitt 2.3.2| l können erw eitert werde n, um koordinierte 



Bahnen für mehrere identische Roboter zu planen iSvestka98i . Aus der Roadmap 
des einzelnen Roboters wird ein Supergraph konstruiert, dessen Knoten kollisions- 
frcie Positionen der kooperierenden Roboter repräsentieren. Kanten des Supergra- 
phen entsprechen der Bewegung eines einzelnen Roboters, während alle anderen 
Roboter an ihrer jeweiligen Position stehenbleiben. In einer kooperativen Bahn aus 
dem Supergraphen müssen die Roboter daher an beliebigen Knoten anhalten und 
beschlcuniuen können, sodass der Algt)rithmus für Anwendungen mit siiznihkanter 
Dynamik kaum geeignet ist. Ein anderer Ansatz zur Koordination von Bewegun- 
gen in Roadmaps ist in lLaValle98l beschrieben. Auch hier wird vorausgesetzt, 
dass die Roboter instantan anhalten oder umkehren können. Die Verfahren werden 
u.a. zur Planung von Einparkmanövern für mehrere Fahrzeuge verwendet. 

Die Koordination in Roadmaps kann als Mittelweg zwischen der Planung im ge- 
meinsamen Konfigurationsraum und der Koordination entlane fester Bahnen nach 
dem Prinzip der Entkopplung von Bahn- und Gcschwindigkeitsplanung aufgefasst 
werden ILaValle9SI. 
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2.3.7 Bewegungskoordination als 
Ressourcenbeiegungsprobleni 

Die kooperative Bewegungsplanung innerhalb eines Straßennetzes lässt sich auch 
als Rcssourccnbclcgungsproblcm auffassen. Diese Sichtweise ist insbesondere bei 
fahrerlosen Transportsystemen in Fabriken oder Containerterminals verbreitet, fin- 
det sich aber auch bei der Verkehrsflussoptimierung an Kreuzungen sowie im 

Luflvcrkchr Ill-raichaid89l IMa/aOll iSchcmmerÖTl IHillcsheimÖTl [SchcpperlcÖ? 



IDresner()5l IMehaniQTl lRL'smeritaQ31 |bruns09| . Kreuzungen oder Fahrspurab- 
schnitte sind dabei Ressourcen, die zu jedem Zeitpunkt exklusiv nur von einem 
Fahrzeug belegt werden können. Ein Fahrzeug kann freie Ressourcen entlang sei- 
nes geplanten Wegs reservieren. Wenn die gewünschte Ressource bereits von ei- 
nem anderen Fahrzeug reserviert wurde, muss gewartet werden. Zyklische War- 
terelationen können zu Verklemmungcn führen, die mit geeigneten Verfahren er- 
kannt und aufgelöst werden müssen fChcnüO.'S IKIimmOSl . 

Wenn eine Ressource von mehreren Fahrzeugen gleichzeitig benötigt wird, lässt 
sich dies als Konflikt zwischen den Plänen der Fahrzeuge interpretieren. Das Ziel 
der Koordination ist dann eine ALiflösang der Konllikte durch Anpassung der Pläne 
IIMartial92llLülh98liri7meni9')llAlanii95l . 



Die meisten Arbeiten verwenden recht einfache Strategien zur Festlegung der Rei- 
henfolge, in der die Fahrzeuge die gewünschte Ressource zugewiesen bekommen, 
etwa den Zeitpunkt des Eintreffens an der Ressource lFraichard89| iSchcmmcrO 1 1 
|IIuhn9 1 1 lPosch82l . Für eine zcitoptimalc Rcsscuirccnbclcgungsplanung können 
Baum suchverfahren eingesetzt werden |Li()6llRebollo()8l . 



2.4 Zusammenfassung 

Bei den meisten Arbeiten zu autonomen Fahrzeugen und Fahrerassistenzsyste- 
men liegt der Schwerpunkt auf der sensorbasierten Wahrnehmung, auf der Ak- 
torik bzw. Regelung oder auf der Mensch-Maschine-Interaktion. Die Verhaltens- 
cntschcidung ist häufig eher einfach ausgeprägt. Als Bci.spiel dafür können die 
Ausweichassistenten angesehen werden, die nur ein einzelnes Hindernis berück- 
sichdgen und mit einer vordefinierten Ausweichbewegung reagieren. 

Hinsichtlich der Kooperation von Fahrzeugen dominieren Forschungsarbeiten zu 
Technologien, Architekturen und Protokollen für die drahtlose Kommunikation. 
Als Anwendungen im Fahrerassistenzbereich werden vorwiegend Warnsysteme 
und Verfahren zur Verkehrsflussoptimierung untersucht. Zu automatisch eingrei- 
fenden kooperativen Sicherheitssystemen, wie sie in der vorliegenden Arbeit be- 
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trachtet werden, gibt es nur sehr wenige verwandte Ansätze in der Literatur. 
Das am ehesten vergleichbare Konzept findet sich bei II Lidaschke94| . Infolge der 
damals verfügbaren geringeren Rechenleistung wird dort mit einer stark einge- 
schränkten Klasse von Manöverkombinationen gearbeitet, und die beschriebenen 
Simulationen beinhalten lediglich zwei kooperierende Fahrzeuge. Ähnlichkeiten 
bestehen ferner zur Arbeit von |(1ark04| . in der PRM-Verfahren zur kooperadven 
Bewegungsplanung für dynamische (iruppen mobiler Roboter eingesetzt werden. 

Bei den Algorithmen zur Bahn- und Bewegungsplanung für mehrere Roboter wer- 
den aufgrund der hohen Problemkomplexität häufig vereinfachende Annahmen ge- 
macht, die eine vernachlässigbare Dynamik voraussetzen oder den Lösungsraum 
der möglichen Ilandlungskombinationen einschränken. Prinzipiell können zwar 
viele Bewegungsplanungsalgorithmen auch im gemeinsamen Konfigurationsraum 
eingesetzt werden. Zur Planung kooperativer Fahrmanöver für vStraßenfahrzeuge 
sind jedoch aus der Literatur keine effizienten Algorithmen bekannt, die auf die 
genannten vereinfachenden Annahmen verzichten. 
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Kapitel 3 



Kooperation kognitiver Automobile 



In diesem Kapitel wird ein Konzept zur Kooperation kognitiver Automobile in Ge- 
fahrensituationen vorgestellt Realisierungsmöglichkeiten für einige Komponenten 
der vorgeschlagenen Systemarchitektur werden kurz erläutert, darunter die Wis- 
sensrepräsentation im gemeinsamen Lagebild und die Situationserkennung. Die 
übrigen Komponenten werden in den folgenden Kapiteln ausführlich behandelt. 
Zunächst wird jedoch auf die Definition von Begriffen wie .Jcognitives Automo- 
hiV\ »^Cooperation** und „Koordination" eing^angen. 



3,1 Begriffsbildung 

3.1.1 Kognitive Automobile 

Unter einem kognitiven Automobil wird im Folgenden ein motorisiertes Straßen- 
fahrzeug verstanden, das mit Sensoren für eine umfassende Umgebungswahmeh- 
mung, mit Aktoren zur vorübergehenden autt}nomen Fahrzeugsteuming und mit 
der FühiL'kcit zur Funkkommunikation ausgestattet ist. Synonym dazu wird der 
Begriff dos kognitiven Fahrzeugs gebraucht. Im Gegensatz dazu wird ein her- 
kömmliches Automobil, das mehr oder weniger ausschließlich von einem I^ah- 
rer gesteuert wird und über keine nennenswerten Kommunikalionsräiiigkeilen ver- 
fügt, als nicht-kugnitives Fahrzeug bezeichnet. 

Um den Unterschied zu kooperierenden kognitiven Fahrzeugen zu betonen, wird 
von der Einzelfahrzeugsichtweise gesprochen, wenn ein intelligentes, autonomes 
Fahrzeug alleine handelt Dies kann auch ein kognitives Fahrzeug sein, das prin- 
zipiell aber die Fähigkeit zur Kooperation verfügt, diese aber im aktuellen Kon- 
text nicht einsetzt, weil keine geeigneten Kooperationsparmer vorhanden sind oder 
weil eine Kooperation für die ausgeführte Aufgabe nicht erforderlich ist. 
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3.1.2 Kooperation und Koordination 

Begriffe wie Koordination, Kooperation und Kollaboration werden in der Literatur 
teilweise synonym und meist ohne explizite Definition verwendet. Diese Termini 
werden in verschiedenen wissenschaftlichen Disziplinen verwendet, unter ande- 
rem in der Soziologie und in den Wirtschaftswissenschaften. Eine konsistente Be- 
griffsbildung in der Informatik fehlt weitgehend. Beispielsweise sind in |Lüth98l 
und |Martial92l unvereinbare Definitionen der Begriffe Kooperation und Koordi- 
nation zu finden. 

Daher werden die verschiedenen Varianten eines kooperativen Verhaltens mehre- 
rer Agenten (vgl. Abschnitt 2.2.5.3| und die in dieser Arbeit verwendete Inter- 



pretation der Begriffe, insbesondere in Bezug auf I ahrzeuge, im Folgenden kurz 
erläutert, siehe dazu auch IPremvuti90llClarkT)4l M urrayOT] . 



Die stärkste Form der Zusammenarbeit liegt dann vor, wenn mehrere Agen- 
ten ein gemeinsames Ziel verfolgen und dafür einen gemeinsamen Plan 
entwickeln (vgl. Abschnitt 2.2.5.3^ . Verschiedene Varianten einer solchen 



Zusammenarbeit werden in der Literatur unter anderem als Teamarbeit 
iTambeOOl . verteilte Problemlösung |Weiss99| , Kooperation lClarkQ4l oder 
Kollaboration llChu-Carroll96l bezeichnet. 

Beispiele sind kooperatives Formationsfahren zu (iberwachungszwecken 
und kooperative Exploration (siehe Kapitel 2?2). Im Straßenverkehr lassen 



sich kaum Anwendunuen für diese Form der Zusammenarbeit finden. Mit 
Einschränkungen kann bei Fahrzeugkonvois von einem gemeinsamen Ziel 
bzw. Teilziel gesprochen werden. Allerdings werden die einzelnen Fahrzeu- 
ge nach der Auflösung des Konvois i. d. R. unterschiedliche Ziele weiterver- 
folgen und können auch ohne die Konvoibildung ihre Ziele erreichen. Daher 
besteht ein fließender Übergang zu anderen Formen kooperativen Verhal- 
tens. 

Mit dem Begriff Kooperation wird in der vorliegenden Arbeit die Erstel- 
lunc und Ausführunu eines gemeinsamen Plans bezeichnet. Unter sewissen 
Rahmenbedingungen kann diese Vorgehensweise selbst dann sinnvoll sein, 
wenn die Agenten individuelle, voneinander unabhängige oder sogar gegen- 
sätzliche Ziele haben. Vorteile gemeinsamer Pläne ergeben sich dadurch, 
dass Konflikte vermieden und Synergien genutzt werden können. 



Die in Kapitel 5 beschriebenen kooperativen Fahrmanöver lassen sich in 



diese Kategorie einordnen. 

3. Statt von vorne herein einen gemeinsamen Plan zu erstellen, kann jeder 
Agent zunächst individuell .seine eigenen Handlungen planen. Die einzelnen 
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Pläne können in einem weiteren Verarbeitungsschritt koordiniert werden, 
insbesondere um Ressourcenkonflikte zu beseitigen (vgl. [Abschnitt 2.3.7) . 



Häufig beschränken sich die Änderungen an den individuellen Plänen auf 
den Zcitvcrlauf der Ausführung. Dabei können zusätzliche Wartezeiten ein- 
gefügt werden, oder die Ausführungsgeschwindigkeit bestimmter Handlun- 
gen wird variiert. Diese Strategie wird in der vorliegenden Arbeit mit dem 
Begriff Koordination bezeichnet. 

Beispiele für eine Koordination sind bestimmte Formen der Verkehrsrege- 
lung an Kreuzungen IBrunsQQI und die Bewegungsplanung für mehrere Ro- 
boter nach dem Prinzip der Entkopplung von Bahn- und Geschwindigkeits- 
planung (siehe [ÄFschnitt 2.3.4. If . 

4. Schließlich kann über ein Kommunikationsmedium Information ausge- 
tauscht werden, ohne jedoch Handlungen abzustimmen oder gemeinsame 
Handlungen zu vereinbaren. Der Kommunikationskanal übernimmt in die- 
sem Fall die Rolle eines zusätzlichen Sensors. 

Ein derartiger Informationsaustausch ist im Straßenverkehr etwa bei Stau- 
und Gefahrenwamsystemen gegeben (vgl. Abschnitt 2.2.1.1| . Bei diesen 



Anwendungen werden lediglich Beobachtungen kommuniziert, nicht jedoch 
eigene Pläne, Handlungsabsichten oder Ziele. Ein Fahrzeug kann zwar auf- 
grund der empfangenen Information seine Pläne ändern, stimmt sie aber 
nicht mit dem Sender oder weiteren Fahrzeugen ab. 

Auch bei vielen Arbeiten aus der Schwarmrobotik ( jAbschiiiu -■2..S. 1) wer- 
den die Handlungen der Kooperationsparmer nicht explizit abgestimmt. 
Vielmehr entscheiden die Mitglieder des Schwarms lokal anhand ihrer Be- 
obachtungen über die nächste auszuführende Handlung. Die Entscheidungs- 
regeln werden so gestaltet, dass sich insgesamt das gewünschte Verhalten 
des Schwarms ergibt. 



Ein weiteres wichtiges Unterscheidungskriterium ergibt sich aus der Frage, wer 
die kooperierenden Agenten sind. Beispielsweise gibt es Softwaresysteme, die 
die Kooperation zwischen mehreren Menschen unterstützen IWörnerQ5l . Vielfach 
untersucht wird auch die Mensch-Maschine- oder Mensch-Roboter-Kooperation. 
Dieser Aspekt ist gerade bei Fahrerassistenzsystemen sehr wichtig |König09| 
IBraess()6l . Assistenzfunktionen, bei denen sowohl Fahrer als auch Fahrzeug einen 
Beitrag zur Lösung der Aufgabe leisten, werden manchmal als kooperative Fah- 
rerassistenzsysteme bezeichnet llIshida041IBrandtQ7llHakuliÖ9l . In der vorliegen- 
den Arbeit sind stets die kognitiven Fahrzeuge die kooperierenden Agenten. Die 
Mensch-Maschine-Interaktion wird hier nicht betrachtet. 
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Weitere relevante Aspekte sind, welcher Anreiz die Agenten zur Kooperation moti- 
viert und welche Maßnahmen Täuschungsversuche einzelner Agenten verhindern. 
Für diese Probleme stellt die Spieltheorie Verhandlungs- und Auklionsmechanis- 
mcn bereit, die Anreize für eine ehrliche Kooperation schatten | Gargü8| |. Der Ein- 
satz spieltheoretischer Mechanismen kann für viele Anwendungen im Verkehrs- 
bereich sinnvoll sein iVasiraniOHl Roughgarden05| , wird aber in der vorliegenden 
Arbeil nicht untersucht. Vielmehr wird davon ausgegangen, dass die Unlallver- 
meidung im Interesse aller Agenten liegt und somit bereits einen starken Anreiz 
zur Kooperation darstellt. Für den Einsatz der verteilten Kooperation im realen 
Straßenverkehr sind Jedoch Maßnahmen zur Sichcrstellung der Vertrauenswürdig- 
keit von Kooperationspartnern, zur Verhinderung von Täuschungen und Angrif- 
fen notwendig. Sie können z.B. auf der Kommunikationsebene realisiert werden 
tRayaQ6t|Nagel07| . 



3.2 Konzept und Systemarchitektur der verteilten 
Kooperation 

In diesem Abschnitt wird der zu Grunde gelegte Ansatz zur Kooperation kogniti- 
ver Automobile vorgestellt, der größtenteils in |Beyerer(T^ vorgeschlagen wurde. 
Es wird angenommen, dass zumindest einige der Verkehrsteilnehmer kognitive 
Fahrzeuge sind, die über Funk miteinander kommunizieren können |Nagel09) . In- 
frastrukturgestützte Systeme werden nicht vorausgesetzt. 

Die Verhallensentscheidung wird innerhalb von kooperativen Gruppen vorgenom- 
men. Diese Gruppen werden dezentral gebildet und laufend an die aktuelle Ver- 
kehrssituaiion angepasst. Kognitive Fahrzeuge gehören zu jedem Zeitpunkt genau 
einer kooperativen Gruppe an. Dadurch stehen die möglichen Kooperationspart- 
ner bereits fest, wenn eine Gefahrensituation eintritt. Dann können rasch Hand- 
lungen abgestimmt werden, und mehrdeutige Ilandlungsanweisungen werden ver- 
mieden. Wegen der Beschränkung der gemeinsamen Verhaltensentscheidung auf 
die Fahrzeuge einer Gruppe kann nicht das globale Optimum für das gesamte Ver- 
kehrssystem erreicht werden. Nach heutigem Stand dürfte dies aber grundsätz- 
lich nicht möglich sein, da der notwendige Kommunikations- und Rechenaufwand 
nicht mehr handhabbar wäre. Das Konzept der kooperativen Gruppen stellt einen 
Kompromiss dar, der sowohl dezentral realisierbar ist als auch die Optimierung 
des kooperativen Verhaltens innerhalb der Gruppe ermöglicht ICIark04l . Für die 
kooperative Kollisionsvermeidung sollten die potenziell an einer Gefahrensituati- 
on beteiligten Fahrzeuge - wenn immer möglich - derselben Gruppe angehören. 
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Entsprechende Kriterien und Algorithmen für die Bildung kooperativer Gruppen 



werden in [Kapitel 4 behandelt. 



Jede Gruppe baut ein gemeinsames Lagebild auf, das die relevante Informati- 
on über die Verkehrsumgebung enthält, insbesondere über das Stral^ennetz und 
die Verkehrsteilnehmer. Zu den relevanten Verkehrsteilnehmern können durch- 
aus auch Fahrzeuge aus anderen kooperativen Gruppen gehören. Diese werden 
jedoch bei der Entscheidungsfindung nicht als Kooperationspartner, sondern nur 
als potenzielle Hindernisse betrachtet. Zur Entscheidung über die Relevanz eines 
Objekts für eine kooperative Gruppe kann der in Kapitel 4.2 definierte Abstands- 



begriff herangezogen werden. Informationsquellen für das gemeinsame Lagebild 
sind die Wahrnehmungen der Einzelfahrzeuge, die mit den in Abschnitt 2.2.2 er- 
wälinten Verfahren fusioniert werden, sowie Vorwissen etwa in Form von Straßen- 
karten. 

Basierend auf dem gemeinsamen Lagebild können Inferenzprozesse zur Situati- 
onserkennung durchgeführt werden. Ziele können u.a. die Erkennung des Fahrcr- 
verhaltens und die Interpretation der Verkehrssituation sein |Vacek()8l . Für die ko- 
operative Kollisionsvermeidung ist insbesondere die Erkennung von Gefahrensi- 
tuationen von Bedeutung, in denen ein automatischer Eingriff durch das System 
erforderlich ist. Darauf wird in Abschnitt 3.5 näher eingegangen. 



Wenn eine Gefahrensituation vorliegt, wird von den Fahrzeugen der kooperativen 
Gruppe ein gemeinsames Fahrmanöver ausgeführt, um einen drohenden Unfall zu 
verhindern oder, wenn dies nicht mehr möglich ist, die Schwere des Unfall zu mi- 
nimieren. Zur Auswahl des kooperativen Fahrmanövers werden Algorithmen zur 



Bcwcgungsplanung für mehrere Fahrzeuge einge.setzt, die in [Kapitel 5| bcschrie- 
bcn sind. Als Grundlage für die Bewertung eines Plans dient ein Verlustfunktional, 
das die verschiedenen Anforderungen an kollisionsfreie, korrekte Pläne beschreibt. 
Der resultierende kooperative Plan wird mit der verbleibenden Toleranz annotiert, 
innerhalb derer eine kollisionsfreie Ausführung garantiert ist. Die Einzclfahrzeuge 
nehmen nun innerhalb dieses Toleranzspielraums eine Feinplanung mit detaillier- 
teren fahrdynamischen Modellen vor, um den Bewcgungsvcrlauf in Bezug auf Kri- 
terien wie Komfort und Energieverbrauch zu optimieren. Anschließend wird das 
kooperative Manöver von den Reglern und Aktoren der Einzelfahrzeuge ausge- 
führt. Eine Verhaltensüberwachung stellt sicher, dass auf unerwartete Ereignisse 
und Abweichungen vom Plan reauiert werden kann. Die letztuenannten Schrit- 
te, die auf Einzelfahrzeugebenc ablaufen, werden in dieser Arbeit nicht behandelt, 
siehe dazu beispielsweise lSchröder09l Dolgov()8 WerlingOSb) . Sobald die Gefah- 



rensituation abgewendet ist, wird die Kontrolle wieder von den Einzelfahrzeugen 
übernommen. 



Selbstverständlich kann es sinnvoll sein, weitere Assistenzfunktionen in das Sys- 
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Abbildung 3.1: Systcmarchitcktur zur verteilten Kooperation von kognitiven Fahr- 
zeugen. 



temkonzept zu integrieren, etwa die kooperative Gefahrenwarnung oder die Ver- 
kehrsflussoptimierung an Kreuzungen (siehe Kapitel 2."2] l. Diese Funktionen lassen 
sich zum Teil mit dem beschriebenen Ansatz der kooperativen Gruppen und des 
gemeinsamen Lagebilds kombinieren, worauf jedoch in dieser Arbeit nicht weiter 
eingegangen wird. 



3.2.1 Realisierung mit Hilfe des Gruppenkoordinators 

Es gibt verschiedene Möglichkeiten, wie die verteilte Entscheidungsfindung in- 
nerhalb einer kooperativen Gruppe realisiert werden kann. Idealerweise sollten 
die Rechenkapazitäten sämtlicher kognitiver Fahrzeuge genutzt werden. Geeignete 
verteilte Algorithmen könnten außerdem eine höhere Robustheit erreichen, wenn 
sie den Ausfall der Kommunikation zu einem der Fahrzeuge kompensieren kön- 
nen. Voraussetzung dafür ist allerdings, dass die Konsistenz der Lagebilder in den 
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beteiligten Fahrzeugen sichergestellt wird, da ansonsten widersprüchliche Ergeb- 
nisse entstehen könnten. Einen möglichen Ansatz für eine konsistente Entschei- 



dungsfindung in verleihen Systemen stellen die in Abschnitt 2.2.5.2 erwähnten 



Konsens-Algorithmen dar, die bisher jedoch nur für deutlich einfachere Probleme 
einiicsetzt wurden. 

Wegen der genannten Schwierigkeilen der verteilten Realisierung wurde für die im 
Rahmen dieser Arbeit durcheeführten Simulationen eine deutlich einfachere Lö- 
sung gewählt. In jeder kooperativen Gruppe wird ein Fahrzeug zum Koordinator 
bestimmt ( |Absc]initt 4.5. |^ . Dieser Koordinator führt dann die weiteren Berech- 



nungen zur Situationserkennung und Bewegungsplanung auf der Grundlage sei- 
nes gemeinsamen Lagebilds durch. Aus einem kooperativen Plan werden lland- 
lungsanweisungen inklusive Toleranz abgeleitet und an die Fahrzeuge der Gruppe 



kommuniziert. Die resultierende Systemarchitektur ist in Abb. 3.1 dargestellt 



Die meisten in dieser Arbeil vorgeschlagenen Konzepte sind weilgehend unabhän- 
gig von der Implementierungsenlscheidung. die Verarbeitung hauptsächlich vom 
Gruppenkoordinator durchführen zu lassen. 



3.2.2 Optinialitätskritcricn 

Wie bereits erwähnt, kann mit dem hier verwendeten Konzept nur das Verhal- 
ten innerhalb einer kooperativen Gruppe optimiert werden. Prinzipiell sind zwar 
allernaiive Ansätze denkbar, die eine Abstimmung des Verhallens zwischen be- 
nachbarten Gruppen vornehmen oder überlappende Gruppen zulassen, sodass ein 
Fahrzeug gleichzeitig mehreren Gruppen angehören kann. Damit entstehen jedoch 
neue Schwierigkeiten, wie das Verhalten im I'alle sich widersprechender Entschei- 
dungen der beteiligten Gruppen oder die zusätzliche Zeilverzögerung durch den 
Abslimmungsschrill. Daher werden solche Ansätze in der vorliegenden Arbeit 
nicht untersucht. 

Die Auswahl des Verhaltens innerhalb der Gruppe erfolgt mit Hilfe eines Ver- 



lusifuiiklionals. das alle Fahrzeuge gleichberechtigt berücksichtigt (siehe Ab 



schnitt i. Anders als bei manchen Arbeiten zu Fahrzeugkonvois oder koope- 



rativer Regelung (Abschnitte 2.2.3.1 und 2.2.5.2| ist der Koordinator hinsichtlich 



der Entscheidungsfindung nicht bevorzugt. Eine S(mderstellung hat er lediglich 
bei der verteilten Berechnung, nicht aber im Optimierungskriterium. Das optimale 
Verhallen für eine kooperative Gruppe kann aus Gründen der Rechenkomplexität 



i.d. R. nur näherunesweise erreicht werden (vel. Abschnitt 2.3.1 i 



Alternativen zur gleichberechtigten Berücksichtigung der Fahrzeuge im Verlust- 
funktional sind spieltheoretische Ansätze (ArchibaldOHl und das Konzept der 
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Pareto-Optimalität |LaVallc98l ICihristO.Sl . Bei der Pareto-Optimicrung wird die 
Menge aller Lösungen berechnet, in denen eine weitere Verbesserung des Plans 
aus der Sicht eines Fahrzeugs nur bei gleichzeitiger Verschlechterung für ein ande- 
res Fahrzeug möglich ist. Problematisch ist neben der höheren Rcchcnkomplcxität 
I Mand()\v()9|| die Frage, nach welchen Kriterien aus dieser Menge die auszufüh- 
rende Entscheidung ausuewählt werden kann. 



3.3 Wissensrepräsentation im gemeinsamen 
Lagebild 

Das gemeinsame Lagebild soll die gesamte relevante Information über eine Grup- 
pe kognitiver Automobile enthalten, sodass es als Grundlage für die Situationser- 
kennung und Verhaltenscntscheidunii dienen kann. Das Lasebild umfasst sowohl 
quantitative Daten wie z. B. Fahrzeugpositionen als auch symbolische hiformation 
wie etwa Relationen zwischen Fahrzeugen, hi das Lagebild gehen die sensoriellen 
Wahrnehmungen der kognitiven Fahrzeuge und A-priori-Information ein. insbe- 
sondere Kartenmaterial und eine Repräsentation der Verkehrsregeln jl Iarland06l . 
Die notwendigen Fusions- und hifcrcnzschrittc sind nicht Gegenstand der vorlic- 
gcnden Arbeit, siehe dazu [Abschnitt l.lH 



Die Wissensrepräseniation für das gemeinsame Lagebild wurde von einer Arbeits- 
gruppe des SFB/Transregio Kognitive Automobile spezifiziert, hii Folgenden wer- 
den einige Aspekte dieser Wissensrepräsentalion kurz vorgestellt. Die vollständi- 
ge Spezifikation findet sich in IBatz06l , siehe dazu auch IHummel09l IVacek081 
IFrescü8allBatzü8l . 

Die in der Verkehrsdomäne vorkommenden Objekte lassen sich danach unter- 
teilen, ob sie prinzipiell beweglich sind oder Bestandteil der stationären Infra- 
struktur sind. Zu den beweglichen Objekten gehören die Verkehrsteilnehmer und 
weitere verkehrsrelevante Objekte, z. B. auf der StraBe befindliche Hindernis- 
se. Die Verkehrsinfrastruktur umfasst Straßen, Fahrbahntrennelemente und Ver- 
kehrszeichen. Nicht betrachtet werden hier Fahrer- und Fahrerverhaltensmodel- 
le, die für bestimmte Assislenzfunktionen ebenfalls von großer Bedeutung sind 
I M cC 'al 10 7 1 iFaste nme ier95l I.Vl ö bu s( )9 1 . 



3.3.1 Verkehrsteilnehmer 



Objekte sind durch ihren Typ, ihre Eigenschaften, ihren Zustand und ihre Fähig- 
keiten charakterisiert. Die relevanten Typen der Verkehrsdomäne sind vor allem 
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die verschiedenen Vericehrsteil nehmer wie Personenwagen, Lastwagen, Radfah- 
rer. Fußgänger, usw. Die Objekttypen lassen sich in eine Hierarchie einordnen 
( Abb. 3. 2) . Ein linterscheidungsicrilerium ist dabei, ob ein Objekt in der Lage 



ist, eigenständig Handlungen zu initiieren. Solche Objekte werden als Agenten be- 
zeichnet. Agenten verfügen i. d. R. über Sensoren, mit denen sie ihren Zustand und 
ihre Umgebung wahrnehmen, und über Aktoren, mit denen sie eigenständig Hand- 
lungen ausführen können. Modelle der Sensoren und Aktoren sind wichtig für die 
entsprechenden Wahrnehmungs-, Inierpretalions-, Planungs- und Regelungsmo- 
dule. 

Objekte können aus mehreren Teilobjekten zusammengesetzt sein. Als Eigen- 
schaften werden diejenigen Attribute eines Objekts bezeichnet, die innerhalb der 
relevanten Zeitspanne unveränderlich sind. Dazu gehört in der Regel die Geome- 
trie, die Masse und die visuelle Erscheinung ( Farbe, Te.xtur, etc.) des Objekts. Die 
Geometrie lässt sich mit unterschiedlicher Detaillierung modellieren. Eine einfa- 
che Beschreibung liefert ein umschreibender Quader, der durch seine Länge, Breite 
und Höhe bestimmt ist. 

Bei Fahrzeugen lassen sich weitere relevante Eigen.schaften angeben, beispielswei- 
se die Motorleistung. Von den Eigenschaften der Fahrwcrksgeomctric sind insbe- 
sondere der Radstand und der Wendekreis von Interesse (vgl. Abschnitt 5.3. 2| . 



Die Ausrüstung mit den verschiedensten Sicherheits- und Assistenzsystemen vom 
Airbag bis zum Navigationssystem ist ebenfalls eine wichtige Information. 

Zum Zustand eines Objekts gehören seine Lage, Geschwindigkeit und Beschleu- 
nigung. Die Lage eines Objekts im dreidimensionalen Raum ist durch einen sechs- 
dimensionalen Vektor {i\ y. z. c^. ö^. o)^ bestimmt. Die Position {x, y. '-:)^ wird 
in kariesischen Koordinaten bezogen auf einen weltfesten Referenzpunkt angege- 
ben. Hierzu kann beispielsweise ein LITM-Koordinatensystem verwendet werden 
IHeimes02l . Die Orientierung wird durch den Wankwinkel r.v,. den Nickwinkel <?)p 
und den Gierwinkel 0 beschrieben (englisch roll, pitch, yaw). Die ersten beiden 
Ableitungen des Vektors nach der Zeil stellen die veklorielle Geschwindigkeit und 
Winkelgeschwindigkeit bzw. die Beschleunigung und Winkelbeschleunigung dar. 

Für bestimmte Objekttypen ist weitere Zustandsinformation sinnvoll. Bei Fahr- 
zeugen ist insbesondere der Zustand der verschiedenen Aktoren von Interesse, 
darunter der Lenkwinkel a (vgl. [Abschnitt 5.372) , die Bremsbetätigung und der 
Motorzustand. Die Stellung des Blinkers und die vom Navigationssystem vorge- 
schlagene Route können zur Schätzung der Fahrerintention verwendet werden. 
Für manche Inferenzaufgaben ist eine Historie der vergangenen Zustände hilf- 
reich. Zur Modellierung von Handlungen und Plänen von Verkehrsteilnehmern 
siehe IVacekü81lH^imesü2l[Pdrkofer031IMock-Hecker94B . 
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Für die kooperative Kollisionsvermeidung sind die fahrdynamischen Fähigkeiten 
von besonderer Bedeutung. Die Brems- und Beschleunigungsfähigkeiten eines 
Fahrzeugs lassen sich durch geschwindigkeitsabhängige Kennlinien beschreiben. 
Die Ilaftungscigenschaftcn der Reifen sollten ebenfalls bekannt sein. Falls Ener- 
gieverbrauch, Schadstoffausstoß oder Verschleiß optimiert werden sollen, müssen 
diese als Funktion der Fahrzeughandlungen wie Beschleunigen und Bremsen spe- 
zifiziert sein. Die Wahrnehmungs-, Kognitions- und Kommunikationsfähigkeiten 
eines Fahrzeugs können ebenfalls im Lagebild aufgeführt werden. 

Abschließend sei kurz skizziert, welche Quellen die benötigte Information für das 
Lagebild liefern können. Jedes kognitive Automobil kennt seine Eigenschaften 
und seinen inneren Zustand: Die Attribute sind entweder a priori bekannt und un- 
veränderlich, wie etwa die Abmessungen des Fahrzeugs, oder sie können mit Hilfe 
von Sensoren und Beobachtern geschätzt werden IVahidiO.^al . Diese Information 
kann über Fahrzeug-Fahrzeug-Kommunikaiion den anderen kognitiven Automobi- 
len zugänglich gemacht werden. Die Eigenschaften von nicht kognitiven Fahrzeu- 
gen und sonstigen Objekten müssen durch sensorielle Wahrnehmung erfasst wer- 
den. Die verbleibenden Zustandsvariablen werden ebenfalls aus Wahrnehmungs- 
daten geschätzt. Als Sensoren kommen unter anderem Kameras, Laserscanner und 
Radarsensoren sowie Odometriesensoren, Inertialsensoren und salellitengestülzte 
Ortungssysteme zur Positionsbestimmung in Frage. Die Ergebnisse der Sensor- 
datenauswertung können an andere kognitive Fahrzeuge kommuniziert werden, 
sodass die Zusiandsschätzung durch die in [Abschnitt 2.2.2| erwähnten Verfahren 
verbessert werden kann. 

Ein großer Teil der Information im Lagebild ist i. d. R. nicht exakt bekannt, son- 
dern mit Sensor- und verarbeitungsbedingten Unsicherheiten behaftet. Die Unsi- 
cherheiten werden im Lagebild durch geeignete probabilistische Modelle reprä- 
sentiert, z. B. durch diskrete Wahrscheinlichkeiten für die Objektt^'pen oder durch 
kontinuierliche Wahrscheinlichkeitsdichten für die Positionen |Ghc][alO| . 



3.3.2 Infrastruktur 



Die verwendete Modellierung der Verkehrsinfrastruktur ist in Abb. 3.3 dargestellt. 
Die gesamte Straßenfläche wird partitioniert in Kreuzungen und Straßen. Jede 
Stelle, an der Vorfahrtsrcgcln zu beachten sind, an der sich Fahrspuren treffen oder 
trennen, wird als Kreuzung aufgefasst. Somit sind z. B. auch Autobahnauffahrten 
und Zebrastreifen als Kreuzungen modelliert. Eine Straße verläuft zwischen zwei 
Kreuzunsen. Sie kann in mehrere Abschnitte unterteilt sein. Innerhalb eines Stra- 
ßenabschnitts bleiben Verkehrsregelungen wie etwa Geschwindigkeitsbegrenzun- 
ijen und Überholverbote unverändert. Straßen und Kreuzuntien beinhalten Fahr- 
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Abbildung 3.2: Klassenhierarchie von Objekten und Verkehrsteilnehmern im La- 
gebild in UML-Notati(in.' 



spuren. Jede Fahrspuij^list Bestandteil von genau einer Straße oder Kreuzung. Ver- 
schiedene Typen von Fahrspuren können unterschieden werden. Auch Fuß- und 
Radwege werden als Fahrspuren aufgefasst. Auf Kreuzungen können sich mehrere 
Fahrspuren überlagern ( Abb. 3.4j >. Jede zulässige Abbiegerelation wird im Lage- 
bild durch eine Fahrspur repräsentiert, selbst wenn in der Realität keine entspre- 
chenden Fahrspurmarkierungen vorhanden sind. Fahrspuren können ebenso wie 
Straßen in Abschnitte unterteilt werden. Zu jedem Fahrspurabschnitt werden die 
relevanten Verkehrszeichen, Markierungen und Fahrbahntrennelemente vermerkt. 
Bei den Markierungen können Begrenzungslinien, Richtungspfeile und Haltelini- 
en unterschieden werden. Fahrbahntrennelemente umfassen Leitplanken, Mauern 



' zur .Spezifikation der Unilied Modeiing Language (UML) siehe (Riimhaiii'.h^->M) 
-im Bauingenieur- und Verkehrswesen auch als Fahrstreifen hezeichnet 
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und Leitpfosten, Bei der Modellierung des Straßennetzes wird in dieser Arbeit 
stets der in Mitteleuropa übliche Rechtsverkehr zu Grunde gelegt. Die Anpassung 
an eine Verkehrsordnung mit Linksverkehr stellt keine prinzipielle Schwierigkeit 
dar. 

Die Geometrie eines Fahrspurabschnitts kann durch verschiedene Modelle be- 
schrieben werden. Eine gerade Strecke ist durch ihren Anfangspunkt, ihre Ori- 
entierung, ihre Länge und ihre Breite eindeutig charakterisiert. Weitere verwende- 
te Geometriemodelle sind Kreisabschnitte, Klothoiden und Splines IJudaschke94l 
[Nagell 1| . Die Beschaffenheit und der witterungsabhängige Zustand der Fahrbahn 
beeinflussen die Haftung der Reifen auf der Straßenoberfläche und somit die mög- 
lichen Fahrmanöver. 

Bei der sonstigen Infrastruktur sind vor allem Gebäude und weitere am Straßen- 
rand stehende Objekte wie Latemcnm asten, Werbcplakatc u. A. relevant. Wichtig 
ist ferner die Beschaffenheit und mögliche Befahrbarkeit der angrenzenden Flä- 
chen wie Felder, Wiesen oder Waldgebiete. 

Quellen für die Umgebungsinformation sind Kartenmaierial und Sensordaten. In 
heutigen Standardkarten sind lediglich die Straßen repräsentiert, nicht die einzel- 
nen Fahrspuren. Zunehmend sind jedoch auch neuere Karten mit fahrspurgenauen 
Daten und zusätzlichen Attributen wie Geschwindigkeiisbegrenzungen verfügbar 
1 A m moii n 1 0 1 IS c h r a u tOQ I . Die Fusion mit der Fahrspur- und Kreuzungswahrneh- 
mung des kognitiven Automobils bleibt dennoch erforderlich, um Abweichungen 
von der Karte zu erkennen, die z. B. durch veraltetes Kartenmaterial oder Baustel- 
len verursacht werden können IThrunlOI . Information über Fahrspurverlauf und 
Verkehrszeichen kann auch über drahtlose Kommunikation übermittelt werden, 
entweder von anderen kognitiven Automobilen oder von Kommunikationseinhei- 
ten der Infrastruktur lvArnim071IToiilminet08I . Für die Schätzung der Haftreibung 
zwischen Fahrbahnoberfläche und Reifen sind verschiedene Ansätze in der Litera- 
tur beschrieben |Rajamani"TÖ| . 



3.3.3 Relationen 

Relationen zwischen den Objekten werden ebenfalls im Lagebild repräsentiert. In 
der Verkehrsdomäne sind vielfältige Relationen vorstellbar IM ü ck 00 1 |H u m m clÖ9l . 



Hier werden lediglich einige Beispiele erwähnt (siehe auch Abb. 3.3 und |3.4| . Bei 



der Verkehrsinfrastruktur gibt es verschiedene Enthaltenseinsrelationen zwischen 
Fahrspuren und Straßen bzw. Kreuzungen sowie zwischen Fahrspurabschnitten 
und Straßenabschnitten. Wichtig sind außerdem Nachfolger- und Nachbarschafts- 
beziehungen zwischen Straßen, Kreuzungen, Fahrspuren, Verkehrszeichen, Fahr- 
bahntrennelemcnten usw. 
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Abbildung 3.3: Ausschnitt aus dem Klasscndiugramm der hitVastruktur. Die Ver- 



crhungsrckitionen zu den Klassen „Entität'' b/Av. „Objekt" aus Abb. 3.2 sind aus 
Clründen der Übersichtlichkeit nicht dareestelU. 



Eine weitere Relation ordnet jedem Verkehrsteilnehmer den Fahrspurabschnitt zu, 
auf dem er sich gerade befindet |Vacek08l . Zwischen Verkehrsteilnehmern lassen 
sich Nachfolger- sowie Vorfahrtsrelationen angeben. 



3.3.4 Ontologiemodellierung 

Die beschriebene Wissensrepräsentation wurde in Form einer Ontologie spezifi- 
ziert. Hierfür wurde die verbreitete Ontologiesprache OWL (Web Oniology Lan- 
guage) verwendet lStaabQ4l . Zusätzlich wurden Axiome definieri, die weitere Be- 
dingungen an eine zulässige Repräsentation formalisicren. Die Konsistenz der re- 
sultierenden Ontologie kann automatisch überprüft werden |1 lummel()9 |. 

Die OWL-Ontologie kann nicht nur zur Veranschaulichung der Modellierung und 
zur Konsistenzprüfung eingesetzt werden, sondern auch direkt zur rechnerinter- 
nen Repräsentation des Lagebilds. In einer Systemarchitektur mit heterogenen 
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Vorfahrt gewähren 



Straße 1 



nachfolgende Fahrspur 



Freu 



1 



t 



i'.un 



Straße 2 



Straße 3 



Vorlahrtsstraße 



benachbarte Falirspur 




Radweg I 



1 



— ► 



Fußgängerüberweg 



Straße 4 



Abbildung 3.4: Veranschaulichung der Modellierung von Straßen, Kreuzungen, 
Fahrspuren und Verkehrszeichen. Die Begrenzungen verschiedener Fahrspuren 
sind als durchgezogene blaue bzw. rote Linien dargestellt, Straßenbegrenzungen 
als durchgezogene schwarze Linien, Abschnittsgrenzen durch gestrichelte Linien. 
Die zulässigen Fahrtrichtungen sind durch farbige Pfeile gekennzeichnet, Relatio- 
nen durch schwarze Pfeile (nach IBatzOöl ). 



kognitiven Fahrzeugen kann die resultierende semandsche Urnweltbeschreibung 
die Interoperabilität der Softwaresysteme erleichtern. Für den Zugriff auf die 
OWL-Konzeple und -Instanzen sind geeignete Software-Bibliotheken verfügbar 
lHorridge07]lMotik06l . 



3.4 Erkennung von Situationsklassen 

Die Interpretation der aktuellen Verkehrssi tuadon ist ein wichtiger Bestandteil vie- 
ler fortgeschrittener Fahrerassistenzsysteme. Wichtige Fragestellungen der Situati- 
onsinterpretation sind u. a. die Erkennung des Verhaltens anderer Verkehrsteilneh- 
mer und die Feststellung der geltenden Vorfahrtsrclationcn IVacck08l . Die meis- 
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ten dieser Aufgaben lassen sich als Klassifikationsprobleme auffassen, bei denen 
geprüft wird, ob bestimmte Situationsklassen wie vSpurwechsel, Überholvorgang, 
etc. vorliegen oder nicht. Zur Situationserkennung können bei kooperativen kogni- 
tiven Fahrzeugen im Wesentlichen die gleichen Algorithmen eingesetzt werden 
wie bei Einzclfahrzcugcn. Dies steht im Gegensatz zur Vcrhaltcnscntscheidung, 
die aufgrund der großen Zahl möglicher Handlungskombinationen für kooperati- 
ve Fahrzeuge eine deutlich größere Komplexität besitzt, und zur Gruppenbildung, 
die bei der Kooperation als zusätzliche Aufgabe auftnil. Die Situalionserkennung 
vereinfacht sich eher, da im Fall kommunizierender Fahrzeuge durch die koopera- 
tive Wahrnehmung eine größere und zuverlässigere Datengrundlage zur Verfügung 
steht. 

Ein weiteres wichtiges Intcrpretationsproblem ist die Erkennung von Hindernissen 
IProvine()4| . In manchen Fällen ist nur schwer feststellbar, ob ein auf der Straße 
liegendes Objekt für das Fahrzeug ein relevantes Hindernis darstellt oder nicht. 
Wegen einer herumliegenden Zeitung oder Plastiktüte sollte kein Ausweichmanö- 
ver riskiert werden, verlorene Ladung kann dagegen je nach Beschaffenheit sehr 
wohl eine Gefahr für das Fahrzeug darstellen. Solche Unterscheidungen sind an- 
hand von Sensordaten oft nur schwer zu treffen. Beispielsweise ist ein Fall bekannt 
geworden, in dem eine Staubwolke als Hindernis interpretiert wurde lUrmsonÜSi . 

Da das gemeinsame Lagebild in einer Ontologiesprache repräsentiert wird, bie- 
tet es sich an, die zur Verfügung stehenden ontologiebasierten Inferenzmechanis- 
mcn zur Situationserkennung zu nutzen. Vorteile dieser Vorgehensweise sind die 
einheitliche Repräsentation und die automatische Konsistenzprüfung der Situa- 
tionsmodelle. Zur Erkennung von l^berholsituationen lassen sich beispielsweise 
logische Bedingungen formulieren |VclWci;he05| . die als Axiome in die Ontolo- 



gie aufgenommen werden können (Shcng07|. Problematisch sind hierbei jedoch 



sowohl die eingeschränkten Ausdrucksmöglichkeiten von Ontologicsprachcn wie 
OWL (OcganO.S) als auch der hohe Rechenaufwand für die Inferenz Iii luiiHncl()9| . 



Einen alternativen Ansatz zur Intentions- und Situalionserkennung im Straßenver- 
kehr stellen Bayes'sche Netze dar (vgl. ^Abschnitt 2. l~4" i. Ein Bayes'sches Netz 



kann beispielsweise zur Erkennung von Überhol- bzw. Spurvvechselmanövern auf 
Grundlage von unsicherer Information eingesetzt werden IKrautorOSI . Eingangs- 
daten für das Netz sind unter anderem die Zeitlücken zu benachbarten Fahrzeu- 
gen. Die bedingten Wahrscheinlichkeitsverteilungen können aus aufgezeichneten 
Daten eines Verkehrssimulators gelernt werden. Femer besteht die Möglichkeit, 
eine Verhaltensentscheidung direkt an die Situationserkennung anzukoppeln (sie- 
he [ÄbschnjttTI). 
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3.5 Erkennung von Gefahrensituationen 



Auf die prädiktionsbasierte Erkennung von Gefahrensituationen wurde bereits in 



Abschnitt 2.1.5 eingegangen. Für die in Kapitel 6 beschriebenen Simulationen 
wurde das Verfahren von IBatz09l eingesetzt, das der Vollständigkeit halber im 
Folgenden kurz dargestellt wird. Es beruht auf einer Prädiktion der unsichcrhcits- 
behafteten Fahrzeugzustände über einen kurzen Zeithorizont und einer Bewertung 
der Kollisionsgefahr anhand der prädizierten Positionen. 



3.5.1 Prädiktion der Fahrzeugpositionen 



Für die Prädiktion wird folgendes Zustandsraummodell des Fahrzeugs c, ange- 
nommen: 



\veli{t)/ 



(veli{t) ■ cos<?),(f)\ 
veli{f) ■ smcl>i{f) 



\ 



acci 



(3.1) 



/ 



Die Notation x bezeichnet die Ableitung der Zustandsgröße x nach der Zeit t. Der 
Zustandsvektor Xj = (.r,, j/j-, 0^, veli)^ umfasst die Position yj)^ des geome- 
trischen Fahrzeugmittelpunkts, die Orientierung öi des Fahrzeugs in der Straßen- 
ebene (Gierwinkel) und seine Längsgeschwindigkeit vel,. Die Gierrate u;, und 
die Längsbeschleunigung acc, werden über den Prädiktionszeitraum als konstant 
angenommen. Dieses Modell kann auch für nicht kooperative Fahrzeuge einge- 
.setzt werden, weil es keine fahrzeugspczifischcn Parameter enthält. Der Anfangs- 
zustand x,(<niin) zu Beginn der Prädiktion sowie u;, und accj werden aus Wahr- 
nehmungsdaten geschätzt. Die resultierende Zustandsunsicherheit wird durch die 
Kovarianzmatrix Px, (^min) beschrieben. 



Der Prädiktionsschritt des Unscented Kaiman Filters IJulier95l mit dem nichtli- 
nearen Systemmodell liefert eine Vorhersage der zukünftigen Fahrzeugzu- 
.stände und ihrer Unsicherheiten. Dabei wird die Wahrscheinlichkeitsverteilung 
über den Zustandsvektor durch mehrere Sigma-Punktc approximiert. Die Sigma- 
Punkte können durch Integration von (j3j} fortgeschrieben werden. Die Rück- 
transformation der Sigma-Punkte liefert den vorhergesagten Zustand (f) und 
seine Kovarianzmatrix Px; (0 für einen Zeitpunkt t innerhalb des Prädiktionszeit- 
raums [fmin,^max]. 
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3.5.2 Situaüonsbewertung 

Aus den prädizierten Größen kann ein Polygon 11^(0 berechnet werden, innerhalb 
dessen sich das Fahrzeug c, zum Zeitpunkt / mit hoher Wahrscheinlichkeit aufhält. 
Dabei werden die Abmessungen des Fahrzeugs berücksichtigt. Eine Kollisionsge- 
fahr liegt vor, wenn der euklidische Abstand f/2(nf(f), ^^{t)) zwischen den Auf- 
enihaltspolygonen zweier Fahrzeuge c,, cj unter einen Schwellwert £p fällt. Das 
Kriterium für eine Gefahrensituation innerhalb der kooperativen Gruppe C} lautet 
daher 

min min 4(^^(0. < • (3.2) 

Die Kollisionsgefahr mit stationären Hindernissen kann mit einer ähnlichen Vor- 
gehensweise beurteilt werden. 

Ein automatisches Eingreifen des Systems ist erforderlich, sobald die Situation 
nicht mehr von den Fahrern bereinigt werden kann. In |Bat7.()9| wurde die ver- 
bleibende Zeit t bis zur drohenden Kollision mit der menschlichen Reaktions- 
zeit verglichen. Ein alternatives Kriterium ist der Zeitpunkt, an dem das Einzel- 
fahrzeug spätestens mit einer kollisionsvermeidenden Handlung beginnen muss, 
vgl. ]7h.ingQ6'] . 



3.5.3 Bestimmung der beteiligten Fahrzeuge 

Die unmittelbar an einer Gefahrensituation beteiligten Fahrzeuge sind diejenigen, 
für die nach (j3?2) eine Kollision droht: 



{ci\3cj4{n^{t),n^{t))<E,} (3.3) 

Durch kollisionsvermeidende Manöver dieser Fahrzeuge könnten aber noch weite- 
re Fahrzeuge mittelbar in die Gefahrensituation verwickelt werden, wenn z. B. ein 
Ausweichmanöver mit der prädizierten Bewegung eines zunächst unbeteiligten 
Fahrzeugs in Konflikt steht. Daher wurde von ISchnebelQ9l vorgeschlagen, die 
erreichbaren Positionen der unmittelbar beteiligten Fahrzeuge unter Berücksich- 
tigung sämtlicher Manöveralternativcn zu berechnen. Die resultierenden Aufent- 
haltsbcrcichc Qf{t) eines beteiligten Fahrzeugs Cj können mit einem Kriterium 
analog zu ( |3.2^ auf die Gefahr einer Kollision mit den prädizierten Aufenthalts- 
bereichen il^{t) eines zunächst unbeteiligten Fahrzeugs cj geprüft werden. Wird 
ein mittelbar gefährdetes Fahrzeug gefunden, so wird es zur Menge der beteiligten 
Fahrzeuge <j3.3| hinzugenommen, und das Verfahren wird iterariv wiederholt. 
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3.6 Zusammenfassung 

In diesem Kapitel wurde ein Konzepl zur verteilten Kooperation kognitiver Au- 
tomobile vorgestellt. Kooperatives Verhalten in Gefahrensituationen wird in der 
Literatur kaum thematisiert, die meisten Arbeiten behandeln Warnsystemc oder 
kooperatives Fahren zur Verkehrsflussoptimierung. Alleinstellungsmerkmale des 
vorgestellten Konzepts sind die verteilte, an die aktuelle Verkehrssituation ange- 
passte Bildung kooperativer Gruppen und die Planung kooperativer Fahrmanöver 
in Gefahrensituationen. 

Die Wissensrepräsentation für das gemeinsame Lagebild einer kooperativen Grup- 
pe modelliert die Verkehrsteilnehmer und die Infrastruktur. Der verwendete Ansatz 
ist vergleichbar mit unabhängig entstandenen Arbeiten aus der Literatur (siehe Ab- 
schnitt 2.l3) . 



Auf die Situationserkennung wurde nur kurz eingegangen, da im Wesentlichen die 
gleichen Verfahren eingesetzt werden können wie für Einzelfahrzeugsysteme. 
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Kapitel 4 



Bildung kooperativer Gruppen 



4.1 Konzept der kooperativen Gruppe 



Innerhalb des in [Kapitel 3.2| beschriebenen Konzepts zur Kooperation kognitiver 
Automobile hat die Gruppenbildiing die Aufgabe, Fahrzeuge zu identifizieren, die 
im Sinne gemeinsamer Fahrmanöver miteinander kooperieren können. Die Grup- 
peneinteilung wird laufend an die aktuelle Verkehrssituation angepasst, sodass zu 
jedem Zeitpunkt festgelegt ist. welche Fahrzeuge als Kotiperationspartner in Frage 
kommen. Dadurch kann ohne Zeitverlust über eine gemeinsame Handlung ent- 
schieden werden, sobald eine Gefahrensiiuation auftritt. Die Notwendigkeit einer 
Gruppenbildung ergibt sich auch aus der potenziell sehr großen Anzahl kommuni- 
zierender Fahrzeuge in einem zusammenhängenden Verkehrssystem. Nur durch 
die Beschränkung auf eine Teilmenge relevanter Kooperationspartner wird der 
Kommunikations- und Rechenaufwand für Situationserkennung und Verhaltens- 
cntscheidung handhabbar. 

Damit die Kooperation innerhalb einer kooperativen Gruppe zur IJnfallvermei- 
dung beitragen kann, muss die Gruppe diejenigen Fahrzeuge umfassen, die poten- 
ziell in eine gemeinsame Gefahrensituation verwickelt werden können. In diesem 
Kapitel werden Kriterien und Algorithmen beschrieben, die eine solche Gruppen- 
bildunu im verteilten Svstcm der koiinitivcn Fahrzcuiic effizient realisieren kön- 



nen. Zunächst wird in Abschnitt 4.2 ein Abstandsbegriff eingeführt, der die spezi- 



ellen Gegebenheiten für Fahrzeuge in einem Straßennetz berücksichtigt. Auf der 



Grundlage dieses Abslands wird in Abschnitt 4.3 eine Bewertunssfunktion defi- 



niert, welche die gewünschten Figenschaften einer kooperativen Gruppe abbildet. 
Die Berechnung der optimalen Gruppcncintcilung bezüglich der Bewertungsfunk- 



tion ist Gegenstand von Abschnitt 4.4| Schließlich wird in Abschnitt 4.5 beschrie- 



ben, wie die Gruppeneinteilung von den kognitiven Fahrzeugen dezentral ausge- 
handelt werden kann. 

Der hier verw endete Begriff der kooperativen Gruppe ist speziell auf das Anwen- 
dungsszenario der kot)perativen Fahrmanöver zugeschnitten. Für andere Anwen- 
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düngen kann eine Kommunikation über die Grenzen einer solchen kooperativen 
Gruppe hinweg durchaus sinnvoll sein. Beispielsweise ist eine Stauwarnung be- 
reits in einer größeren Entfernung vom Stauende nützlich, wenn der Stau noch um- 
fahren werden kann. Auch bei der kooperativen Wahrnehmung können Fahrzeu- 
ge, die nicht zur Gruppe gehören, wichtige Informationen weiterleiten. Für solche 
Warn- und Informationssysteme sind daher andere Gruppenstrukturen angebracht 
als die hier verwendeten. Es ist aber durchaus vorstellbar, die hier verwendeten 
Kriterien zur Bildung kooperativer Gruppen an diese Anwendungen anzupassen. 



Zu unterscheiden sind kooperative Gruppen auch von den in Abschnitt 2.2.3.1 



beschriebenen Fahrzeugkonvois. Konvois werden zur Verkehrsflussoptimierung 
aus Fahrzeugen gebildet, die ähnliche Ziele haben, während kooperative Grup- 
pen Fahrzeuge umfassen, die potenziell zueinander in Konflikt stehen. Eine direkte 
Folge davon ist beispielsweise, dass Konvois nur Fahrzeuge mit gleicher Fahrtrich- 
tung umfassen, kooperative Gruppen sich hingegen auch auf den Gegenverkehr 
erstrecken können. 



4.2 Abstandsmaß 

4.2.1 Anforderungen 

Im Hinblick auf Kriterien zur Gruppenbildung wird in diesem Abschnitt ein Ab- 
standsbegriff für Fahrzeuge im Straßennetz definiert, der folgende Kriterien erfül- 
len soll: 

1. Der Abstand zweier Fahrzeuge soll gering sein, wenn sie gemeinsam an 
einer kritischen Verkehrssituation beteiligt sind, d. h. insbesondere wenn die 
Gefahr der Kollision beider Fahrzeuge besteht. 

2. Der Abstand soll ebenfalls gering sein, wenn die Fahrzeuge in naher Zukunft 
in eine solche kritische Situation geraten könnten. Daher dari" der Abstands- 
begriff nicht ausschließlich die momentane Verkehrssituation bewerten, son- 
dern muss zusätzlich eine gewisse zeitliche Vorausschau ermöglichen. Für 
die beabsichtigte Anwendung sollte der Vorausschauhorizont etwa im Be- 
reich von wenigen Sekunden bis zu einer Minute liegen. 

3. Wenn eine derartige kritische Verkehrssituation für zwei Fahrzeuge ausge- 
schlossen werden kann, soll ihnen ein großer Abstand zugewiesen werden. 



4. Um die genannten Anforderungen erfüllen zu können, muss das Abstands- 
maß die Straßentopologic berücksichtigen. Insbesondere sollte modelliert 
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Abbildung 4.1: Mögliche Einteilung von Fahrzeugen in kooperative Gruppen ^i, 
Q-iy in einem Szenario mit baulich getrennten Fahrbahnen und einer Brücke. 

werden, dass Fahrzeuge auf baulich getrennten Straßen sich nicht in einer 
kritischen Verkehrssituation befinden können, die kooperative Fahrmanöver 
erfordert. Beispiele für baulich getrennte Fahrspuren sind die beiden Rich- 
tungsfahrbahnen einer Autobahn mit Mittcllcitplankc sowie die Straßen auf 
und unterhalb einer Brücke ( [Ahh. 4. 1| . In der Realität sind bauliche Fahr- 
bahntrenner nicht vollkommen unüberwindlich. Wenn ein Fahrzeug etwa 
die Mittelleitplanke durchbricht, kommt es aber dennoch nicht als Koopera- 
tionspartner in Frage, weil es infolge der Kollision so stark beschädigt sein 
dürfte, dass es nicht mehr zu kontrollierten kooperativen Fahnnanövern in 
der Lage ist. 

5. Eine effiziente Berechnung des Abstands muss möglich sein. 



Anhand dieser Anforderungen wurde die Zeit bis zum nächstmöglichen Treffen 
zweier Fahrzeuge im Straßennetz als ein sinnvoller Abstandsbegriff identifiziert. 
Vor einer genaueren Erläuterung dieses Abstandsbegriffs wird zunächst die ge- 
wählte Repräsentation des Straßennetzes beschrieben. 



4.2.2 Straßengraph 

Ein Straßennetz kann auf naheliegende Weise als Graph aufgefassl werden 
IIRussellQ3l . Ein Knoten des Graphen entspricht einem Ort im Straßennetz, und 
eine Kante zwischen zwei Knoten entspricht einer Straße bzw. Fahrspur, welche 
die betreffenden Orte miteinander verbindet. 

Häufig werden die Knoten an Straßenkreuzungen und -Verzweigungen platziert 
LSchultcsOSl . In dieser Arbeit wird jedoch ein etwas anderer Ansatz gewählt. Zu- 
nächst wird eine Partition der Straßenfläche konstruiert. Jedem Element dieser 
Partition entspricht genau ein Knoten v des Straßengraphen Tt. Ein Vorteil dieser 
Vorsichenswci.se ist, dass einem Fahrzeug auf einfache Art und Weise ein Knoten 
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zugeordnet werden kann, an dem es sich aktuell im Straßennetz befindet. Eine ge- 
richtete Kante e= (^1,^2) zwischen den Knoten t'i und V2 von Tl existiert genau 
dann, wenn der Straßenverlauf eine direkte Fahrt von vi nach t'o erlaubt. Sie ist 
mit der minimal benötigten Fahrzeit w{o) gewichtet. 

Konkret wird der hier verwendete Graph TZ. nach folgenden Regeln konstruiert: 

• Eine Fahrspur wird in Knoten v partitioniert, wobei jeder Knoten einem 
Abschnitt mit einer Länge von höchstens /v.max entspricht. Die Geometrie 
eines Knotens v wird durch ein Polygon beschrieben. 

• Zwischen je zwei in Fahrtrichtung aufeinanderfolgenden Knoten einer Fahr- 
spur wird eine Kante angelegt. 

• Am Ende einer Fahrspur werden Kanten zu den ersten Knoten der longitu- 
dinal nachfolgenden Fahrspuren eingefügt. 

• Sofern Spurwechsel möglich sind, wird von jedem Knoten eine Kante zu 
einem Knoten der lateral benachbarten Fahrspur angelegt. 

• Das Gewicht w{e) einer Kante e = {v\,V2) ist gegeben durch die minima! 
benötigte Fahrzeit t^yn'- 

w{e) := /,nin(e) = j ' , (4.1) 

wobei w/max(e) die maximal mögliche Geschwindigkeit beim Passieren von 
t und d-iie) die euklidische Distanz zwischen den Flächenschwerpunkten 
der Polygone ^{vi) und ^{vn) von <'i und V2 bezeichnet. Die Maximalge- 
schwindigkeit ?'e/max(f ) wird durch den Kurvenverlauf der Straße und durch 
die dort gültigen Verkehrsregeln begrenzt. Für Letzteres ist relevant, ob es 
sich um eine Autobahn, Landstraße oder innerstädtische Straße handelt, und 
ob eine spezifische Höchstgeschwindigkeit vorgeschrieben ist. Nach dieser 
Definition gilt w{e) > 0 für alle Kanten e. 



Ein Beispiel eines nach diesen Regeln konstruierten Straßengraphen ist inlAbb. 4.2 



dargestellt. In dieser Arbeit wird angenommen, dass die für den Aufbau des Gra- 



phen benötigte Information im gemeinsamen Lagebild verfügbar ist (siehe Ab- 
[schnitt 3.3T2) . 

Die Funktion : c v ordnet einem Fahrzeug c denjenigen Knoten v von IZ 
zu, in dessen Polygon i).{v) sich der geometrische Mittelpunkt von c befindet. Da 
sich die Fahrzeugposition mit der Zeit ändert, ist auch i^ti{c) zeitvariant. Zur Ver- 
einfachung der Notation wird jedoch auf die explizite Angabe der Abhängigkeit 
von der Zeit / verzichtet. 
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(a) Ausschnitt eines Straßennetzes und Paitition in Polygone (blau) 




(b) Graph 7v zu dem Süaßennetz aus|(ä)l 
Abbildung 4.2: Beispiel für die Konstruktion des vStraßengraphen 71. 
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4.2.3 Definition des AbstandsbcgrifTs 

Ein Weg von t'i nach t'o in 7v ist eine zusammenhängende Folge von Kanten, so- 
dass v\ der Anfangspunkt und v-y der Endpunkt der Folge ist. Der kürzeste Weg von 
i'i nach t'2 ist derjenige Weg mit minimaler Summe der Kantengewichte entlang 
des Wegs. Die Länge des kürzesten Weges ist gegeben durch die Summe seiner 
Kantengewichte und wird mit /^^(t'i, i'2) bezeichnet. Sie entspricht der kürzesten 
möglichen Fahrzeit von vi nach <'2 und kann mit dem Algorithmus von Dijkstra 
berechnet werden ICc^rmcnOl NSchultesOBI . 

Die Länge des kürzesten Weges ist im Allgemeinen kein sinnvoller Abstandsbe- 
griff für Fahrzeuge im Straßennetz, weil sie die aktuellen Fahrzeugpositionen als 
statisch annimmt und die mögliche zeitliche Weiterentwicklung der Verkehrssitua- 
tion unberücksichtigt lässt. Wenn sich beispielsweise zwei Fahrzeuge aufeinander 
zu bewegen, können sie sich in der Mitte des Weges treffen. Dann wird bis zum Zu- 
sammentreffen nur halb so viel Zeit benötigt wie ein einzelnes Fahrzeug braucht. 



um den gesamten kürzesten Weg zurückzulegen. Abbildung 4.3 veranschaulicht 
diesen Effekt anhand der Fahrzeuge c\ und co. Bei Einbahnstraßen und richtungs- 
getrennten Fahrbahnen ist hingegen ein Treffen in der Mitte nicht möglich. Daher 



sollte der Abstand der Fahrzeuge ci und C3 in Abb. 4.3 trotz vergleichbarer räum- 
licher Distanz größer sein als der Abstand der Fahrzeuge c\ und c-y. 

Ein möglicher Treffpunkt zweier Fahrzeuge Ci, Cj ist ein Knoten Vm von 7?,, 
den beide Fahrzeuge erreichen können. Der zeitliche Abstand eines Fahrzeugs 
zu t'in ist durch die Länge des kürzesten Weges in 7^ gegeben: />tc(<'r v^), 
i=l,2. Bis beide Fahrzeuge r,,, erreicht haben, vergeht mindestens die Zeit 

inax{/^7;(i?7j(ci)). t'm),/>re(i'7j(<^'2))- ^'m)}- Der früheste erreichbare Treffpunkt ist 
nun derjenige Knoten € 'R-, für den dieser Term sein Minimum annimmt. Da- 
mit erhält man folgende Definition für den hier verwendeten Abstandsbegriff 

Definition 4.1 (Abstandsmal'i für Fahrzeuge im Straßennetz) Der Abstand dji 
zweier Fahrzeuge ci, C2 im Straßengraphen 71 wird definiert als 

dn{c\,C2):^ min max{p;.(iri, rm),PR(v2,i'in)} : (4.2) 
wobei Vi •— VTi{ci) für i ^ 1, 2. 



Der Abstand (//j(ci,C2) kann interpretiert werden als die minimal benötigte Zeit, 
bis beide Fahrzeuge den nächstmöglichen gemeinsamen Treffpunkt Vm erreicht 
haben. Dieser Treffpunkt ist virtuell in dem Sinne, dass die Fahrzeuge sich in der 
Realität möglicherweise erst .später, an einem anderen Punkt oder gar nicht treffen 
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Abbildung 4.3: Veranschaulicliung des Konzepts des nächstmöglichen 
gemeinsamen Treffpunkls Vm. Blaue Trennlinien deuten die Partition 
der Siraßenfläche in Polygone an. Pfeile kennzeichnen die zulässigen 
Fahrtrichtungen. Unter der Annahme w{e) = \ für alle Kanten e 
erhält man in diesem Beispiel l>R.{v\,V2) = V^, />7^(^^2, t^i) = 21, 
aber dn {c\ , C2) = ma.x{pR (/'i . r,,, ).}>r {v2, Vm)} = max{2, 3} = 3. Ferner ist 
<in{ci,C2^) = pTi{vz,vi) = 5, also t/;? (^i. C3) > ^/7^(cl, C2). 



werden. Mit Hilfe des nächstmöglichen gemeinsamen Treffpunkts erhält man eine 
untere Schranke für die Zeit bis zu einem mösHchen Zusammentreffen der beiden 
Fahrzeuge, die für die Anwendung der kooperativen Kollisionsvermeidung eine 
konservative Abschätzung darstellt. 



4.2.4 Eigenschaften des Abstandsmaßes 



Im Folgenden wird untersucht, oh der Abstandshegriff aus DcHmtion 4. 1 die Axio- 
me einer Metrik erfüllt lLaV'allc()6l Kapitel 3. 1 J. 



Lemma 4.2 (Eigenschaften des AbstandsmaRes) Das Abstandsmaß djz nus De- 



tiniiion 4.1 erfüllt für beliebige ri. rj folgende Eigenschaften: 



(a) dji{ci,C2) > 0 (Nichtnegativität) 

(bj <i/c(fi, <^i) = 0 (Rcflcxivität) 

(c) dTi{ci,C2) = dTz{c2,c\) (Symmetrie) 
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Abbildung 4.4: Dieses Gegenbeispiel zeigt, dass die Dreiecksungleichung für dji 
nicht gilt. Mit //'(t)=l für alle Kanten ist f/7i(ci, C2) = 2, dn{c.2,CA) ^2 und 
(^r{<'\ < <".i) = •^>. Somit ist dn{c-[ , c:^) = T) > 1 = dn {c\ , C2) + djz {c2, c.s), während 
die Drciecksunglcichung dR{c\,c:^) < dn{('\. ('i) + (<"2i <"3) fordert. 



Beweis: Die Aussagen folgen unmittelbar aus der definierenden Gleichung 
und den Eigenschaften /Jr (t'i . vo) > 0, p,^ {v^ . v\ ) — 0 kürzester Wege. □ 

Insbesondere die Symmetrie ist eine wünschenswerte Eigenschaft im Hinblick auf 
eine Bewertung kritischer Verkehrssituationen, da eine Kollisionsgefahr entweder 
für beide beteiligte Fahrzeuge vorliegt oder für beide Fahrzeuge nicht vorliegt. 
Eine Metrik ist dj^ jedoch nicht, da die Dreiecksungleichung nicht erfüllt ist. In 
Abb. 4.4 wird dies anhand eines Gegenbeispiels nachgewiesen. Die Verletzung der 



Drciecksunglcichung ist nicht als Schwäche des Abstandsbegriffs zu sehen, 
sondern als Eigenschaft, die sich unmittelbar aus den gestellten Anforderungen 
ergibt. Die berechneten Abstände df> genügen den gewünschten Anforderungen, 



und es erscheint nicht sinnvoll, im Beispiel von Abb. 4.4 einen geringeren Wert 



von (/r:(ci,C3) zu verlangen, damit die Dreiecksungleichung erfüllt ist. 



4.2.5 Algorithmische Berechnung 

Ein effizienter Algorithmus zur Berechnung des Abstands '/k' (/'i . ^2) kann durch 
geeignete Erweiterung des Algorithmus von Dijkstra zur Berechnung kürzester 
Wege in Graphen ICormenO 1 1 Kapitel 24.3] hergeleitet werden. Hierzu wird, aus- 
gehend von den beiden Fahrzeugpositionen V] = {c\) und v-y = Vr{c2), simultan 
jeweils eine Kürzeste-Wege-Suche gestartet. Der nächste abzuarbeitende Knoten 
wird mit Hilfe einer Prioritätswarteschlange ausgewählt, die den Knoten r mit 
minimalem ;>r(''i. bzw. pn{v2, v) zurückliefert. Die Berechnung wird solange 
fortgeführt, bis sich die beiden Suchfronten an einem Knoten treffen (Abb. 4.5^ 



Bei diesem Knoten muss es sich um den nächstmöglichen gemeinsamen Treff- 
punkt r,„ handeln, da die Bearbeitung der Knoten in aufsteigender Reihenfolge 
des Abstands vom jeweiligen Startknoten erfolgt. Der gesuchte Abstandswert er- 
gibt sich dann nach {X.1) zu ^«(ci.ro) = inax{;);c (''i , i'm),;^^ (''-j- 'm)}- 
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Abbildung 4.5: Veranschaiilichung der algorithmischen Berechnung des Abstands 
<Ir{<'\^<'2) im Graphen R. Bis der früheste gemeinsame Treffpunkt r,„ gefunden 
wird, erreicht die Suche ausgehend von den Positionen der beiden Fahrzeuge die 
in der jew eiligen Farbe hervorgehobenen Knoten. 



In [Anhang A. l| wird der skizzierte Algorithmus genauer beschrieben und analy- 
siert. Dort wird auch gezeigt, dass die Berechnung des Abstandsmaßes dj^ für A'^ 
Fahrzeuge in einem Straßengraphen TZ mit V Knoten mit einem Rechenaufwand 
von 0(.V^ • V • log(\^)) möglich ist. 



4.3 Bewertungsfunktion 

Das im vorangegangenen Abschnitt definierte Abstandsmaß bildet eine wichtige 
Grundlage für das Kriterium zur Bildung kooperativer Gruppen. Neben einem ge- 
ringen Abstand in diesem Sinne gibt es allerdings noch weitere Bedingungen, die 
die Fahrzeuge einer Gruppe erfüllen sollten. Dazu gehört beispielsweise die An- 
forderung, dass eine Gruppe nicht zu groß werden darf. Folgende Eigenschaften 
einer Gruppe werden als wünschenswert angesehen: 

• Die Fahrzeuge einer Gruppe sollten untereinander geringe Abstände im Sin- 



ne des Abstandsbegriffs (/r aus Definition 4.1 haben. 



• Fahrzcuüc, die sich bei iicrinücm Abstand aufeinander zu bcwciicn, scillten 
in einer Gruppe sein i Abb. 4.6i a){ l. Hin Fahrzeug, dass sich von allen Grup- 



penmitgliedern entfernt, muss hingegen selbst im Fall geringer Abstände 
nicht in die Gruppe aufgenommen werden ( )Abb. 4.6(b]t - 



• Eine koiiperative Gruppe sollte eine sinnvolle Größe haben. Wie schon in 



Abschnitt 4. 1 erläutert, ist eine effiziente Verhaltensentscheidung nur mög- 



lich, wenn die Gruppe nicht zu groß wird. Umgekehrt schränken zu klei- 
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Abbildung 4.6: Motivation für das Kriterium der Relativgeschwindigkeit: Wenn 
sich Fahrzeuge aufeinander zu bewegen, ist die Entstehung einer Gefahrensituation 
wahrscheinHcher, als wenn sie sich voneinander entfernen. 



ne Gruppen die Möglichkeiten der Kooperation zu stark ein. hn Extremfall 
einer Gruppe, die nur aus einem einzigen Fahrzeug besteht, ist gar keine 
Kooperation mehr möglich. 

• Die Gruppe sollte über eine gewisse Zeitspanne bestehen bleiben. Insbeson- 
dere soll mehrfaches Wechseln zwischen zwei alternativen Gruppcncintci- 
lungen verhindert werden. 

Modelliert werden diese Kriterien durch eine zu minimierende Bewertungsfunk- 
tion »{Q), die sich additiv aus mehreren Termen zusammensetzt. Bei der zu be- 
wertenden kooperativen Gruppe Q — {c]_. . . . , c,\i } aus Af kognitiven Fahrzeugen 
kann es sich sowohl um eine existierende als auch um eine hypothetische, d. h. neu 
zu bildende, Gruppe handeln. Auf diese Weise ist es möglich, alternative Grup- 
peneinteilungen miteinander zu vergleichen. 

Der Abstandsterm sd{Q) der Bewertungsfunktion berücksichtigt die Abstände 
d^{ci, Cj) zwischen allen Paaren von Fahrzeugen in der Gruppe Q: 

M ^ M 

i=i ^ j-i 

Für jedes Fahrzeug r, wird der mittlere Abstand zu den M — 1 anderen Fahrzeugen 
Cj berechnet. Diese Mittelwerte werden anschließend aufsummiert, sodass jedes 
Fahrzeug der Gruppe einen Beitrag zum Abstandsterm liefert. Die oben formulier- 
ten Anforderungen besagen, dass geringe Abstände der Fahrzeuge einer Gruppe 
wünschenswert sind, was einer Minimierung von entspricht. 

Die Relativbewegung der Fahrzeuge wird mit Hilfe der Ableitung des Abstands- 
maßes dji nach der Zeit ausgedrückt. Eine positive Ableitung ^^re (<^h Cj) bcdcu- 
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tet, dass sich die Fahrzeuge r, und Cj im Sinne des Abstandsbegriffs voneinan- 
der entfernen, während sie sich bei negativer Ableitung aufeinander zu bewegen. 
Die Relativbewegung ist besonders dann von Bedeutung, wenn die Fahrzeuge un- 
tereinander geringe Abstände haben. Bei großen Abständen sind ohnehin keine 
kooperativen Fahrmanöver möglich, weshalb die Relativbewegung in diesem Fall 
keinen Einfluss auf die Gruppenbildung nehmen sollte. Daher wird die Ableitung 
des Abstandsmaßes durch den Abstand djz (q, Cj) dividiert. Analog zu der Vorge- 
hensweise beim Abstandsterm werden diese Quotienten für jedes Fahrzeug gemit- 
telt und die Ergebnisse anschließend über alle Fahrzeuge aufsummieri: 

I— 1 j(— 1 ^. j j 

Die Maximumbildung mit dem Schwcllwert ^/mm im Nenner von ( |4.4{ l dient da- 
zu, eine Division durch Null zu verhindern. Bezogen auf die gesamte kooperative 
Gruppe Q kann der Term .sy als Maß für die Ausdehnungs- bzw. Kompressions- 
rate der Gruppe interpretiert werden. Eine Gruppe erhält eine bessere Bewertung, 
wenn die Fahrzeuge sich aufeinander zu bewegen, während die Ausdehnung der 
Gruppe einen höheren Strafterm in s\ zur Folge hat. 

Um die Gruppengröße zu bewerten, wurde ein Intervall (A/„ii„. A/max] für eine sinn- 
volle Anzahl der Fahrzeuge in einer Gruppe definiert. Bei kleineren Gruppen ist 
Kooperation nur selten möglich, bei größeren Gruppen ist die verteilte Entschei- 
dungsfindung kaum noch handhabbar. Die Bewertung.sfunktion »s ist innerhalb 
des gewünschten Intervalls identisch Null und steigt außerhalb quadratisch an: 

r (A/ - A/™n)2 falls M < M^,, 
ssiG) < ü falls A/,„i„ < M < A4„ (4.5) 

i(A/- A/,nax)- falls Ai > A/„,ax 



Für Gruppen Q = {r}, die nur aus einem Fahrzeug bestehen, können der Abstands- 



term (j43jl und der Geschwindigkeitsterm ( {4.4^ nicht sinnvoll definiert werden, so- 
dass in diesem Fall 'Sd(^) 0 und .sv(^) := 0 gesetzt wird. Solche Gruppen kön- 
nen daher nur durch den Stiafterm ss verhindert werden. Die Bildung zu großer 
Gruppen wird in der Regel bereits durch den Anstieg des Abstandsterms unterbun- 
den, sodass der Größenterm in diesem Fall von geringerer Bedeutung ist. 



Die zeitliche Stabilität der Gruppeneinteilung kann gewährleistet werden, indem 
eine Gruppe während der ersten Zeitspanne (O.tj) ihres Bestehens eine bessere 
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Bewertung erhält. Sei /, die Zeit, die seit dem Beitritt von Fahrzeug r, z.ur Gruppe 
Q vergangen ist. Dann wird der Term für zeilliche Konstanz .sj wie folgt definiert: 



M 



.„., E (,; 



ti falls 0 <t,<tj 

(4.6) 

falls ti = l) oder t, > tj 



Der Fall f j = 0 beschreibt den hypothetischen Beitritt von Fahrzeug c, zu Q. Der 
Term sj bewirkt eine zeitliche Hysterese und verhindert Oszillationen zwischen 
zwei oder mehreren alternativen Gruppeneinteilungen. Solche Oszillationen könn- 
ten andernfalls durch geringfügige Schwankungen der Abstände oder durch Quan- 
tisierungseffekte verursacht werden. 

Die Stabilität einer kooperativen Gruppe ist besonders wichtig, wenn tatsächlich 
eine Gefahrensitualion eintritt und ein kooperatives Fahrmanöver durchgeführt 
wird. In einem solchen Fall muss die Aufteilung der betroffenen Fahrzeuge auf 
mehrere Gmppcn verhindert werden. Dies kann prinzipiell durch einen zusätzli- 
chen Term der Bewertungsfunktion modelliert werden. Finfacher ist es jedoch, die 
Aufspaltung der Gruppe auf der Ebene des weiter unten beschriebenen Verhand- 
lungsprotokolls zu blockieren. 

Die Gesamtbewertung einer kooperativen Gruppe Q wird nun als gewichtete Sum- 
me der vorgestellten Terme definiert: 



'<G) ■■ Ad • soiG) + Av • »y(G) + As • ssiQ) + Aj ■ sj(g) (4.7) 



Auf die Wahl der Gewichtungsfaktoren A,^ > 0 (/v— D,V,S,T) wird in Ab- 



schnitt 6.2.3 eingegangen. Die resultierende Gruppeneinteilung wird überwiegend 
vom Abslandsterm .sd bestimmt, während die Terme s\ und sj im Wesentlichen 
zur Auswahl zwischen Alternativen mit ähnlicher Abstandsbewertune dienen. 



4.4 Berechnung der optimalen Partition 

Die möglichen Gruppeneinteilungen für eine Fahrzeugmenge C ^ {n r^} 

sind durch die Menge 'P{C) aller Partitionen von C gegeben. Die Bewertung einer 
Partition P wird definiert als Summe der Bewertungen ihrer Gruppen: 

s{F) := J2 ■'^(G) (4.8) 

Die Terme .s^, .sy und sj der Bewertungsfunktion enthalten einen Beitrag für jedes 
Fahrzeug der Gruppe, .sodass die Gesamtzahl der Summanden in s{P) für alle P € 



4.4 Berechmmg der optimalen Partinon 



61 



V{C) identisch ist. Dadurch wird verhindert, dass sich die Anzahl der Gruppen 
direkt auf diese Terme auswirken kann. Vielmehr wird die Gruppengröße explizit 
im Tcrm .ss berücksichtigt. 

Die optimale Gruppeneinteilung F* ist diejenige Partition mit minimaler Gesamt- 
bewertung: 

P* = argmin.s(P) = arg min V] s{g) (4.9) 

Mit dieser Bcrcchnungsvorschrift lassen sich sämtliche Ereignisse im Lebenszy- 
klus kooperativer Gruppen einheitlich behandeln. Der Übergang zur neuen opti- 
malen Partition P* kann beispielsweise einer Vereinigung mehrerer Gruppen zu 
einer neuen Gruppe, einem Übertritt einiger Fahrzeuge von ihrer bisherigen Grup- 
pe zu einer benachbarten Gruppe oder einer Aufspaltung einer Gruppe in mehre- 
re Gruppen entsprechen. Spezielle Regeln für die einzelnen Ereignisse sind nicht 
erforderlich, da sämtliche Möglichkeiten durch den Vergleich der aktuellen Grup- 
peneinteilung mit hypothetischen Alternativen abgedeckt werden. 



4.4.1 Nachbarschaftsbedingung 

Um den Kommunikations- und Rechenaufwand der verteilten Gruppenbildung zu 
begrenzen, wird die Berechnung der optimalen Partition innerhalb einer lokalen 
Nachbarschaft vorgenommen. 

Wenn sich kognitive Fahrzeuge dezentral in kooperativen Gruppen organisie- 
ren, steht ihnen nur Information über die Fahrzeuge in einer lokalen Umgebung 
zur Verfügung. Neben dieser kommunikationstechnisch bedingten Einschränkung 
lässt sich die Menge der relevanten Nachbarn aber auch mit Hilfe des Abstandsbe- 
griffs cIt^ beschreiben. Formal kann die Nachbarschaft zweier Gruppen Q{) und Qi 
wie folgt charakterisiert werden: 

NB{go..GY) (4.10) 

Anschaulich bedeutet dieses Kriterium, dass sich zwischen und Q\ keine wei- 
tere Gruppe Q befindet. 

Nun wird für jede Gruppe die Menge aller benachbarten Fahrzeuge gebildet: 

C{G,,) := Go U{ceG\ NB{Go. G)} (4.11) 

Mit Hilfe von Gleichung ( |4.9| wird die optimale Gruppeneinteilung für diese Fahr- 
zeugmenge C{Go) berechnet. Wenn die bisherige Gruppenzuordnung vom berech- 
neten Optimum abweicht, werden entsprechende Gruppcnwechsel durchgeführt. 
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Durch die Beschränkung der Optimierung auf die lokale Nachbarschaft kann nicht 
garantiert werden, dass eine global optimale Gruppenstruktur gefunden wird. Es 
ist aber sichergestellt, dass jeder durchgeführte Gruppenwechsel auch die globale 
Gcsamtbcwcrtung nach verbessert. 



4.4.2 Komplexität der Partitionierung 

Die möglichen Gruppen in einer Menge C von A' Fahrzeugen entsprechen den 
Teilmengen, also den 2'^ Elementeij^ der Potenzmenge. Eine Partition entsteht 
durch Kombination mehrerer Teilmengen. Die Menge V{C) der Partitionen ist 
daher noch größer als die Potenzmenge. Ihre Mächtigkeit wird durch die Bcll- 
Zahlen D^; beschrieben, die mit Hilfe der Binomialkoeffizienten wie folgt rekursiv 
definiert sind ICameron94|| : 



' 1 für A' = 0 



iEr-:(i-;) ßA'-< für.v>i 

Die exakte Optimierung über alle Partitionen ist für eine realistische Anzahl 
von Fahrzeugen mit zu großem Rechenaufwand verbunden. Branch-and-Bound- 
Melhoden erlauben zwar, die Suche nach der optimalen Gruppeneinteilung auf 
eine Teilmenge aller Partitionen einzuschränken, können aber dennoch keine Echt- 
zeitfähigkeit garantieren. 

Auch ein Approximationsalgorithmus, der eine Garantie für die maximale Ab- 
weichung seines Ergebnisses vom Optimum geben kann, ist offenbar nicht effizi- 
ent realisierbar: Für das verwandte Problem der Koalitionsbildung in der koope- 
rativen Spieltheorie ist bekannt, dass eine exponentielle Anzahl an Koalitionen 
evaluiert werden muss, bevor eine Approximationsgarantie gegeben werden kann 
||Sandh(^lm9S|| . 



4.4.3 Approximative Partitionierung 

Wegen der geschilderten Problemkomplexität wird zur Berechnung der Gruppen- 
einteilung ein schneller approximativer Algorithmus ohne Optimalitätsgarantie 
eingesetzt. Die Vorgchcnswcisc des Algorithmus ähnelt dem Prinzip der hierar- 
chischen Ballung lEverittl II : Das Verfahren beginnt mit den Gruppen, die aus nur 
einem Fahrzeug bestehen, und fasst sukzessive Gruppen zusammen, wenn sich da- 
durch die Gesamtbewertung verbessert. In jedem Schritt wird jede mögliche Kom- 
bination zweier Gruppen evaluiert und diejenige mit der größten Verbesserung der 

' mit Ausnahme der leeren Menge, die keiner sinnvollen Gruppe entspricht 



4.5 VerhandhingsprotokoU 



63 




(j 




Abbildung 4.7: Illustration der hierarchischen Zusammenfassung von Fahrzeugen 
zu kooperativen Gruppen mit dem gierigen Algorithmus. 



Gesamtbewertung ausgewählt ( Ahh. Damit erhält man einen einfachen gie- 
rigen Algorithmus, der sehr schnell eine gute Gruppcncintcilung findet. Der Al- 
gorithmus terminiert, sobald eine Verbesserung der Gesamtbewertung durch eine 
Vereinigung zweier Gruppen aus der aktuellen Hinieilung nicht mehr möglich ist. 

Anstatt die evaluierten, aber nicht ausgewählten Gruppeneinteilungen P zu ver- 
werfen, kann man sie in eine Prioritätswarteschlange einfügen und sukzessive wei- 
terverfolgen. Die Warteschlange wird nach der Gesamtbewertung s{F) sortiert, 
und die jeweils beste Gruppeneinteilung wird wcitcrverfolgt. Mit dieser Erweite- 
rung kann der Algorithmus prinzipiell die optimale Partition finden, allerdings ist 
dies für größere Fahrzeugmengen wegen des Rechen- und Speicheraufwands nicht 
praktikabel. Wenn die Suche nach einer festgelegten Zeitspanne abgebrochen wird, 
ergibt sich ein Any-Time- Verhalten: Es kann bereits sehr schnell ein gutes Ergeb- 
nis zurückgegeben werden, das eventuell weiter verbessert werden kann, wenn 



mehr Rechenzeit zur Verfügung steht. Der beschriebene Algorithmus ist in An- 



hang A.2 im Pseudocode wiedergegeben. 



4.5 Verhandlungsprotokoll 

Da beim hier verwendeten Systemkonzept keine infrastrukturbasierte Kommuni- 
kation vorausgesetzt wird, gibt es keine zentrale Stelle, an der die gesamte zur 
Gruppenbildung benötigte Information vorliegt. Vielmehr müssen die kognitiven 
Fahrzeuge sich ohne Infrastrukturunterstützung in Gruppen organisieren. Um die 
Gruppenzuordnung berechnen zu können, muss zunächst die benötigte Informati- 
on zwischen den Fahrzeugen ausgetauscht werden. Bei der Umsetzung der Grup- 
peneinteilung ist darauf zu achten, dass alle Fahrzeuge eine konsistente Sicht auf 
die Gruppenstruktur haben. 
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In diesem Abschnitt wird ein auf Nachrichtenebene spezifiziertes Verhandlimgs- 
protokoU vorgestellt, mit dem die Gruppeneinteilung zwischen den Fahrzeugen 
ausgehandelt werden kann. Das Protokoll dient lediglich dazu, die Machbarkeit 
der Gruppcnbildung im verteilten System nachzuweisen. Es erhebt nicht den An- 
spruch, Optimalitätskritericn hinsichtlich der Robustheit oder des Kommunikati- 
onsaufwands zu erfüllen. Für die Umsetzung in einem realen Assistenzsystem soll- 
te ein gemeinsames Protokoll für alle Systemkomponenten unter Berücksichtigung 
des zu Grunde liegenden Kommunikalionssystems entworfen werden. 

Wichtiger Bestandteil des Verhandlungsprotokolls ist der Gruppenkoordinator, 
ein ausgezeichnetes Fahrzeug in jeder kooperativen Gruppe. Der Koordinator 
übernimmt die Verhandlungen mit anderen Gruppen über eine Änderung der Grup- 
peneinteilung. Durch diese Trennung zwischen der Kommunikation mit anderen 
Gruppen und der Kommunikation innerhalb einer Gruppe lässt sich eine klare 
Strukturierung des Protokolls und eine Reduktion des Datenvolumens erreichen. 
Ähnliche Ansätze werden auch in anderen Arbeiten zur Gruppenbildung verwen- 
det (siehe [Abschnitt 2.?]6) . 

Der Gruppenkoordinator muss jederzeit über den Zustand aller Fahrzeuge in der 
kooperativen Gruppe informiert sein, um die erforderlichen Ent.scheidungcn tref- 
fen zu können. Daher sendet jedes Gruppenmitglied periodisch eine Nachricht mit 
seiner Identifikationsnummer und seiner aktuellen Position an den Gruppenkoor- 
dinator. Dabei wird angenommen, dass die Identifikationsnummer netzwerkweit 
eindeutig ist. Für die durchgeführten Simulationen wurde eine Periode von 10 Hz 
für die Positionsmeldungen verwendet. 

Die Gruppenkoordinatoren senden periodisch eine Broadcast-Nachrichl an alle 
Fahrzeuge in Kommunikationsreichweite, um die Existenz der kooperativen Grup- 
pe bekannt zu machen. Diese Nachrichten dienen einerseits den Mitgliedern der ei- 
genen Gruppe als Bestätigung dafür, dass die Kommunikation mit dem Koordina- 
tor noch funktioniert. Andererseits sind sie erforderlich, um im dezentralen Fahr- 
zeugnetzwerk ohne Infrastrukturunterstützung neue benachbarte Gruppen entde- 
cken zu können. Auf der Grundlage der Bekanntmachungsnachrichten wird die 
Nachbarschaftsbedingung ( |4.1Q^ ausgewertet. Koordinatoren benachbarter Grup- 



pen tauschen Information über den Zustand ihrer Gruppen aus, um gemäß \A.9) 
die optimale Partition P* für die Fahrzeuge in der lokalen Umgebung berechnen 
zu können. Sobald ein Koordinator eine Verbesserungsmöglichkeit der Gruppen- 
einteilung findet, sendet er einen entsprechenden Vorschlag an den anderen betrof- 
fenen Koordinator. Im Normalfall bestätigt dieser die Änderung der Gruppenein- 
teilung, und jeder Koordinator informiert die Mitglieder seiner Gruppe über den 
Gruppenwcchscl. Ein Vorschlag wird nur dann abgelehnt, wenn er auf veralteter 



4.5 Verhandlungsprotokoll 



65 



Gruppen kcxirdinator 



• / sende Bekanntmachung 
Position empfangen / - 



Berechne Gruppeneinteilung 



Antwort empfangen 
/ sende ggf. 
Gruppenwechsel 



Verbessenmg Vorschlag 
gefunden empfangen 
/ sende Vorschlae / - 



Vorschlag geprüft / 
sende Antwort und 
ggf. Gruppenwechsel 



Waitc auf Antwort 



Prüfe Vorschlag 



Gruppenwechsel 
empfangen 
/- 



[ ) /usland 

% ► An fangszii stand 

Ereignis / Aktion 



zustimmende 
Antwort empfangen / 
sende Giuppcnwechscl 



Vorschlag geprüft und 
angenommen / sende 
zustimmende Antwort und 
Grtippenwechsel 



Gruppenniitglied 



- / sende Position 
Bekanntmachung empfangen / 
Gruppenwechsel empfangen / ■ 



Abbildung 4.8: Vereinfachte Spezifikation des Verhandlungsprotokolls als hierar- 
chischer endlicher Automat (UML-Zustandsdiagramm). Wenn eine neue Grup- 
peneinteilung realisiert wird, kann der Folgezustand je nach Ergebnis der Ein- 
teilung und Koordinatorauswahl entweder Gruppenkoordinator oder Gruppenmit- 
glied sein. 



Information basiert, insbesondere wenn der zweite Koordinator zwischenzeitlich 
bereits einen anderen Gruppenwechsel initiiert oder durchgeführt hat. 



Das skizzierte Protokoll wird in |Abb. 4.8| in Form eines endlichen Automaten spe- 
zifiziert. Abbildung 4.9 illustriert einen beispielhaften Ablauf durch ein Sequenz- 
diagramm. Um eine Robustheit gegen Nachrichtenverluste im Funknetzwerk zu 
erreichen, werden für den Verhandlungsablauf bestätigte Nachrichten verwendet: 
Nachrichten vom Typ Vorschlag, Antwort und Gruppenwechsel werden vom Kom- 
munikationssystem so lange wiederholt, bis eine Bestätigung vom Empfänger ein- 
geht. Für den Fall, dass die Kommunikationsverbindung zu einem Fahrzeug dau- 
erhaft abreißt, sind zusätzliche Maßnahmen erforderlich, die den Systemzustand 
nach einem erfolglosen Warten zurücksetzen IDoblerl II . 
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Gruppenwechsel 



Gruppenwechsel I 



Position 



Position 




Abbildung 4.9: UML-Scqucnzdiagramm des Vcrhandlungsprotokolls (nach 
IlFrcNcOShI IDoblcrlTj ). Die Gruppenmitglieder versenden periodische Positions- 



nachrichten an ihren Koordinator. Die Koordinatoren, im Beispiel zunächst c\ und 
C3, machen ihre Gruppe über Broadcast-Nachrichten bekannt. Benachbarte Koor- 
dinatoren tauschen Positionsdaten ihrer Gruppen aus, um neue Gruppcncintcilun- 
gen berechnen zu können. Im Beispiel sendet ci einen Vorschlag für die Anpas- 
sung der Gruppeneinteilung an c^. Koordinator ra stimmt zu, und die Gruppen- 
mitglieder werden über die neue Zuordnung informiert, in der der Gruppe Q\ 
beitritt und eine neue Gruppe Q-^ mit als Koordinator gebildet wird. 
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4.5.1 Auswahl des Gruppenkoordinators 

Ein Wechsel des Griippenkoordinalors wird nach Möglichiceit vermieden, da er 
stets mit einem zusätzlichen Kommunikations- und Rechenaufwand für die Initia- 
lisierung und daher mit einem Zeitverlust verbunden ist. In manchen Fällen ist 
jedoch die Bestimmung eines neuen (jruppenkoordinalors zwingend notwendig, 
z. B. wenn sich eine Gruppe aufspaltet. Dann stellt sich die Frage, nach welchen 
Kriterien der neue Koordinator ausgewählt werden soll. Einfache Möglichkeiten 
sind eine zufällige Auswahl oder eine Festlegung aufgrund der Identilikations- 
nummern. Sinnvoll wäre es, einen Koordinator zu finden, welcher der Gruppe 
noch möglichst lange angehört. Eine entsprechende Heuristik könnte die Wahl 
des Fahrzeugs sein, das sich gemäß der Bewerlungsfunktion in der ..Mitte" der 
kooperativen Gruppe befindet: 

argmin V {\ü-dn{r.c') \ Av • ^(/tc (c, c) ) (4.13) 
c£G \ dt J 

Hierbei wird angenommen, dass der Übertritt zu einer anderen Gruppe für Fahr- 
zeuge am Rand einer Gruppe wahrscheinlicher ist als für das mittlere Fahrzeug. 
Zudem kann unter Umständen die Sendeleistung der Funkkommunikation redu- 
ziert werden, wenn sich der Koordinator in der Mitte der Gruppe befindet und 
somit die geringsten Abstände zu den anderen Gruppenmitgliedern aufweist. Bei 
heterogener Ausrüstung der Fahrzeuge wäre eine weitere Alternative, das Fahr- 
zeug mit der besten Rechner-, Kommunikations- oder Sensorausstattung zum Ko- 
ordinator zu bestimmen. 



4.5.2 Kommunikationsaufwand 

Für die Realisierbarkeit im realen Straßenverkehr ist eine wichtige Voraussetzung, 
dass der Kommunikationsaufwand für die Gruppenbildung nicht zu einer Überlas- 
tung des Kommunikationssystems führt. Die Paketgröße der einzelnen Nachrich- 
tentypen im beschriebenen Verhandlungsprotokoll wird in UDoblerl 1 1 untersucht. 
Eine grobe Abschätzung ergibt, dass die vom Verhandlungsprotokoll beanspruch- 
te Datenrate deutlich unterhalb der zu erwartenden Bandbreite einer WLAN- 
basicrtcn Fahrzeug-Fahrzeug-Kommunikation liegt. Da jedoch weitere System- 
komponenten wie die kooperative Wahrnehmung (siehe Abschnitt 2.2.2| einen 



erheblichen Kommunikationsbedarf haben dürften, sollte jede Möglichkeit zur 
Reduzierung des Datenvolumens genutzt werden. Bei dem Verhandlungsproto- 
koll zur Gruppenbildung ergibt sich Einsparpotenzial durch die Zusammenfas- 
sunsi mehrerer iilcichzciriii versendeter Nachrichten zu einem Paket und durch die 
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Vermeidung redundanter Inhalte. Eine weitere Möglichkeit ist eine inkrementelle 
Codierung, bei der nur die Änderungen im Vergleich zur vorangegangenen Nach- 
richt übermittelt werden lRobinson07l . Werden diese Maßnahmen umgesetzt, so 
entfallt ein Großteil des verbleibenden Kommunikationsaufwands auf die Posi- 
tionsnachrichten. Da die Fahrzeugpositionen auch für andere Komponenten und 
Anwendungen wichtig sind, ist der Zusatzaufwand für die (iruppenbildung ver- 
gleichsweise gering. Periodische Positionsmeldungen mit einer Frequenz von et- 
wa iU Hz werden auch in vielen Arbeiten zur Fahrzeug-Fahrzeug-Kommunikation 
verwendet (MangellTj . 



4.6 Zusammenfassung 

In diesem Kapitel wurde die Bildung kooperativer Gruppen aus Fahrzeugen be- 
schrieben, die potenzielle Gefahrensituationen durch gemeinsame Fahrmanöver 
vermeiden können. Basierend auf einem Abstandsbegriff für Fahrzeuge im Sti*a- 
ßennetz wurden Bewertungskriterien für kooperative Gruppen hergeleitet und ef- 
fiziente Algorithmen zur verteilten Gruppenbildung vorgestellt. Die Gruppenbil- 
dung wurde als Optimierungsproblem formuliert, wodurch alle Ereignisse im Le- 
benszyklus kooperativer Gruppen einheitlich behandelt werden können. Somit ent- 
fällt die Notwendigkeit, für die einzelnen Ereignisse spezielle Regeln aufzustellen, 
deren Konsistenz nicht ohne weiteres gewährleistet werden kann. 

Vergleichbare Kriterien zur Gruppenbildung für kooperative Sicherheitssysteme 
wurden in der Literatur kaum untersucht. Am ehesten ist noch der regelbasierte 
Ansatz aus iChisalitaü7| mit dem hier vorgeschlagenen Konzept verwandt. Et- 
was weiter verbreitet ist das alternative Prinzip, die Gruppencinteilung auf der 
Grundlage von prädizierten Positionen oder von potenziellen Konflikten vorzuneh- 
men (siehe Abschnitt 2.2.6f . Bei diesen Verfahren entsteht jedoch deutlich mehr 



Rechen- und Kommunikationsaufwand, da für alle Fahrzeuge in Funkreichweite 
eine Situationsbewertung durchgeführt werden muss. Außerdem können im dich- 
ten Verkehr prinzipiell beliebig große Gruppen entstehen, sodass Ilandlungsein- 
heiten von handhabbarer Größe nicht gewährleistet werden können. 

Schließlich wurde in diesem Kapitel ein Verhandlungsprolokoll vorgestellt, mit 
dem sich kognitive Fahrzeuge dezentral in kooperativen Gruppen organisieren 
können. Dabei werden ähnliche Mechanismen verwendet wie in der Literatur zur 
Gruppenbildung für andere Anwendungen. Simulalionscrgcbnisse der verteilten 
Gruppenbildung werden in Kapitel 63 beschrieben. 
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Kapitel 5 

Bewegungsplanung für kooperierende 
Fahrzeuge 



In Kapitel 1 . 1 wurde erläutert, wie ein automatisches Eingreifen in Gefahrensitua- 
tionen mit mehreren beteiligten Fahrzeugen zur Vermeidung von Unfällen beilra- 
gen kann. In einer Gefahrensituation müssen die kognitiven Fahrzeuge zunächst 
entscheiden, welches kooperative Fahrmanöver durchgeführt werden soll. Die- 
ses Kapitel behandelt Algorithmen zur Planung solcher Manöver. Nicht disku- 
tiert wird, wie die Entscheidungsfindung im verleilten System einer kooperativen 
Gruppe ablaufen könnte. Einige Überlegungen zu dieser Frage wurden bereits in 
Abschnitt 3.2.1 [ skizziert, siehe dazu auch |Abschnitt 7.2 



Zunächst w ird in 
formal definiert. 



.'\b schnitt .S. 



Abschnitt 5.2 



das Problem der kooperativen Bewegungsplanung 
erörtert, welche aus der Literatur bekannten Pla- 
nungsalgorithmen für die vorliegende Anwendung eingesetzt werden können. An- 
schließend w erden drei .A.Igorithmcn zur koopcrati\cn Bewegungsplanung ausge- 
arbeitet: 



• ein Baumsuchalgorithmus, der sich auf vorberechnete untere Schranken 
stützt < | Abschnitt 5.3^ , 



eine Formulierung als gemischl-ganzzahliges lineares Programm (MILP, 
Abschnitt 5.4| , 



die Methode der elastischen Bänder i jAbschnitt 5.5| > 



Die Beschreibung des Baumsuchverfahrens wird genutzt, um Grundlagen, Nota- 
tionen und Modelle für die Nebenbedingungen und Ziele der Bewegungsplanung 
einzuführen, auf die bei den anderen Planungsalgorithmen zurückgegriffen werden 
kann. Am Schluss des Kapitels werden verschiedene Nachverarbeitungsschritte 
kurz beschrieben ( Abschnitt 5.6| . 
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5.1 Formulierung des Bewegungsplanungsproblems 

In diesem Abschnitt wird das Problem der kooperativen Manöverplanung genau- 
er spezifiziert, (icgeben sind M kooperative Fahrzeuge, die an einer CJefahrensi- 
tualion beteiligt sind. Es kann sich dabei um alle Fahrzeuge einer kooperativen 



Gruppe handeln, oder um eine Teilmenge, die mit dem in Abschnitt .^.5..^ erwähn 



ten Verfahren bestimmt wurde. Ein Planungsalgorithmus muss auf der (irundiage 
der Information aus dem gemeinsamen Lagebild ein kooperatives Fahrmanöver 
berechnen, das bestimmte Anforderungen erfüllt. Folgende Information über die 
Fahrzeuge ci, . . . , c^i und ihre Umgebung wird als bekannt angenommen: 

1. geometrische Beschreibungen der Fahrzeuge: üj, i = 1, . . . , M 

2. Zustandsraummodellc der Fahrzeugkinematik und -dynamik: /, (x,, n,, A/) 

3. Beschreibung der Topologie und Geometrie il, der relevanten Straßen, 
r £ Rands 

4. Geometrie und Position von Hindernissen: J = 1, . . . , Aobsi 

5. Anfangszustand der Fahrzeuge: xf*"^ 

Der Anfangszustand beschreibt Position und Geschwindiskeit der Fahrzeuge zu 
Beginn der Manöverausführung. Wenn die benötigte Zeit für Planung und Kom- 
munikation berücksichtigt wird, entspricht der Anfangszustand nicht dem aktu- 
ellen Zustand, sondern einer Prädiktion um ein entsprechendes Zeilintervall (sie- 
he dazu Abschnitt 3.5. H l. Für diese Prädiktion ausgehend vom aktuellen Zustand 



müssen gewisse Annahmen getroffen werden, z. B. dass während des Prädiktions- 
intervalls weiterhin die aktuelle Handluno ausgeführt wird. Im Fall einer iterierten 
Planung und Ausführung kann dies als gesichert gelten, da die Handlune durch 
den Plan aus dem vorangegangenen Schritt bestimmt ist. 

Für die Zwecke der Kollisionsvermeidung wird die Geometrie der Fahrzeuge mit 
dem Konzept des Konfigurationsraums modelliert. Unter der Konfiguration eines 
Körpers versteht man eine parametri.sche Beschreibung, welche die geometrische 
Lage aller Punkte des Körpers eindeutig speziliziert ILozano-Perez83| . Der Kon- 
figurationsraum ist die Mannigfaltigkeit aller zulässiger Konfigurationen des Kör- 
pers. Die Dimension des Konfigurationsraums entspricht der Anzahl der Freiheits- 
grade für mögliche Bewegungen des Körpers ilLaValleOöii . 

Ein Automobil Cj kann im vorliegenden Kontextals staner Körper angeschen wer- 
den, wenn man Bewesunuen wie das Ein.schlas>en der lenkbaren Räder und das 



5. / Formulierung des Bewegungsplanungsprohlenis 



71 



Öffnen der Türen vernachlässigt. Das Automobil befindet sich stets auf der Stra- 
ßenflächc, die in ausreichender Näherung als eben modelhert werden kann. Im 
Fall von übereinander verlaufenden Straßen oder Brücken ist die Kooperation auf 
eine der Straßen beschränkt, sodass nur die betreffende Ebene betrachtet werden 
muss (vgl. [Kapitel 4| . Somit ist die Konhguration von r, durch die drei Parame- 
tergegeben, die einen starren Körper auf einer Ebene charakterisieren llLaValle06i 
Abschnitt 4.2. ij: 

q» = \yi\ (3.1) 

Die Position des geometrischen Mittelpunkts des Fahrzeugs auf der Straßenebene 
wird in einem weltfesten kartesischen Koordinatensystem durch (-r,, i/,)^ be- 
schrieben, die Orientierung durch den Gierwinkel <!);. Der Konfigurationsraum 
von Ci wird mit Q, bezeichnet. Für Gelenkfahrzeuge wie Sattelzüge und Anhän- 
ger müssen zusätzliche Parameter eingeführt werden ||Laumond08IISü-thn07| . Dies 
wird hier nicht weiter betrachtet, stellt aber keine prinzipielle Schwierigkeit dar. 

Die Geometrie des Fahrzeugs q lässt sich für die Zwecke der Kollisionsvermei- 
dung durch die Fläche ili charakterisieren, die es auf der Straßenebene einnimmt. 
Wenn sich das Fahrzeug in Konfiguration befindet, belegt es die Fläche ^^(q^). 
hl den meisten Fällen sollte es ausreichen, die Fahrzeuggeometrie durch ein über- 
approximierendes Rech leck zu modellieren. 

Auf ähnliche Art und Weise kann auch die Geometrie der Hindernisse J2'j'''"(q"^'"), 

j=l jVobst. beschrieben werden. Weitere Überlegungen zur Modellierung 

von Hindernissen und Straßen wurden bereits injKapitel 3.3|vorgestellt. 



Straßenfahrzeuge sind in ihrem Bcwcgungsspielraum durch ihre kinematischen 
und dynamischen Eigenschaften eingeschränkt. Die Kinematik hat im Wcsendi- 
chen zur Folge, dass sich ein Fahrzeug nur in Richtung der Stellung seiner Räder 
bewegen kann. Die Dynamik bedeutet, dass die zulässigen Beschleunigungen be- 
schränkt sind. Ein Beispiel für die Modellierung dieser Einschränkungen im Rah- 
men eines Bewegungsplanungsverfahrens wird weiter unten in Abschnitt 5.3.2 ge- 
geben. 

Eine Bahn ist eine stetige parametrische Kurve [U. 1] — ' Q, im Konfigurationsraum 
ILaValle06l Abschnitt 4.1.3]. Eine Bewegung oder Trajektorie ist eine Abbildung 
Kmin- Anaxl — * Q< von einem gegebenen Zeitintervall in den Konfigurationsraum. 
Im Unterschied zur Bahnplanung wird bei der Bewegungsplanung also der zeitli- 
che Ablauf explizit berücksichtigt. Für die kooperative Kollisionsvermeidung er- 
scheint dies aus den beiden folgenden Gründen notwendig: 

• Die Fahrzeuudvnamik erlaubt in Abhänsitzkeit von der Geschwindiiikeit un- 
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tcrschicdlichc Kiirvcnradien, d. h. die Menge der zulässigen Bahnen variiert 
niil dem zeitlichen Verlauf der Bewegung. 

• Die Kollisionsvermeidung mit bewegten Hindernissen soll möglich sein. 

Bei mehreren kooperativen Fahrzeugen kann jedes Fahrzeug seine Konfiguration 
unahhängiii von den Konfigurationen der anderen Fahrzeuge einnehmen. Daher 
ist der gemeinsame Konfigurationsraum Q das kartesische f^rodukl der einzelnen 
Konfigurationsrüume Q,: 

Q = X Qi (5.2) 

Eine kooperative Bewegung ist eine Abbildung i/|„,„. UwaA ~' Q- Bewegungs- 
planungsalgorithmus sollte eine kooperative Bewegung berechnen, die im An- 
fanuszustand der Fahrzeuize bcuinnt und den Finschränkunsien durch die Fahr- 
zeugdynaniik, die Kollisionsvermeidung sowie die Straßengeometrie genügt. 

Für die hier betrachteten Bewegungsplanungsprobleme werden zusätzlich folgen- 
de Voraussetzungen angenommen: 



Die Bewegungsplanung wird als deterministisches Problem aufgefasst. Die 
untersuchten Algorithmen können probabilistisch modellierte Unsicherhei- 
ten nicht direkt berücksichtigen, sondern nur in Form von Sicherheitsreser- 
ven in den Geometriemodellen (zur Behandlung unsicherer Information sie- 
he auch |Abschnitt 5.3. l"l und |7.2[ . 



Der Planungshorizont w'ird dem Bewegungsplanungsverfahren von außen 
vorgegeben. Der Startzeitpunkt wird zur Vereinfachung der Notation m\tt = 
0 bezeichnet, sodass eine Planung für das Zeilintervall [0. /h| durchgeführt 



wird. Zur Wahl des Planuneshorizonts siehe Abschnitt 6.4 



Das Rückwärtsfahren der Fahrzeuge wird hier ausgeschlossen, d.h. die 
Fahrzeuge fahren entweder vorwärts oder sie stehen still. In einigen Kreu- 
zungsszenarien könnte Rückwärtsfahren unter Umständen einen sinnvol- 
len Beitrag zur kooperativen Kollisionsvcrmeidung darstellen. Manche Pla- 
nungsalgorithmen, etwa das in Abschnitt 3.3| beschriebene Baumsuchver- 



fahren, könnten relativ einfach um die Möglichkeit des Rückwärtsfahrens er- 
weitert werden, dies wird hier jedoch nicht weiter betrachtet. Für Planungs- 
verfahren, die mit R ück wä rtsf ahren umgehen kcinnen, siehe ||Schröder()9l 
M ontemerlolM ISvestka^^ . 



Zwei Bewegungen mit identischen Anfangs- und Endpunkten heißen homotop, 
falls sie durch eine stetige Transformation ineinander überführt werden können 
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IlLaVallcOOl Abschnitt 4. 1.3J. Für ein Ausweichmanöver an einem Hindernis be- 
deutet dies beispielsweise, dass eine Bewegung, die das Hindernis mit i in Ab- 
stand linivs passiert, zu einem Ausweichen nach links mit 2 in Abstand homotop 
ist, nicht jedoch zu einem Ausweichen nach rechts. Die Optimierung, insbeson- 
dere Glättung, einer Bewegung ist innerhalb einer Ilomotopieklassc mit relativ 



geringem Rechenau 


"wand mög 


l(leraerts061IHein03l 


Svestka98l 



iWillelOllMagesO? 



konzept wird dieser Schritt im Rahmen der Feinplanung auf Einzelfahrzeugebene 
durchseführt. 

Die Aufgabe der kooperative Bewegungsplanung ist daher vor allem die Auswahl 
einer Homotopicklasse, weniger die Optimierung innerhalb der Homotopieklassc. 
Die Struktur des Konfigurationsraums kann nicht effizient berechnet werden, so- 
dass die Suche nach einer Homotopicklasse mit einer kollisionsfreien Lösung ein 
schwieriges Problem ist. 



5.2 Mögliche Lösungsansätze 

Die Entscheidungsfindung über das auszuführende kooperative Fahrmanöver muss 
nicht zwangsläufig als Bewegungsplanungsproblem aufgefasst werden. Alternativ 
könnten beispielsweise Regeln formuliert werden, die in Abhängigkeit von Ab- 
ständen, Geschwindigkeiten, etc. über das Ausweich- oder Bremsmanöver ent- 
scheiden. Solche Regeln werden bei Kollisionsvermeidungssystemen für Einzel- 
fahrzeuse und beim Fluszeuekollisionsvermeidunsssvstem TCAS eingesetzt (sie- 



he Kapitel 2 . Eine weitere Möglichkeit sind vorgegebene Trajektorien für Aus- 
weichmanöver, die entsprechend der konkreten Gefahrensituation parametriert 
werden JlscrmannOSl . Diese Ansätze betrachten vergleichsweise einfache Szena- 



rien wie das Ausweichen bei einem einzelnen Hindernis. Im Fall mehrerer Hin- 
dernisse ist offenbar bereits der Einsatz von Bewegungsplanungsalgorithmen er- 
forderlich, um ein allgemeines EnLscheidungsproblem erfolgreich lösen zu kön- 
nen llSchmidt()6l . Dies gilt umso mehr im hier behandelten Szenario mit mehreren 
kooperativen Fahrzeugen sowie beliebigem Straßenverlauf. Daher wird in dieser 
Arbeit ausschließlich die Bewegungsplanungsformulierung weiterverfolgt. 

Wie in Abschnitt 2.3.4| erläutert, beruhen die meistverwendeten Verfahren zur ko- 



operativen Bewegungsplanung auf Entkopplungsannahmen. Durch die Entkopp- 
lung wird einerseits der Rechenaufwand stark reduziert, andererseits aber auch 
die Menge der zulässigen Pläne eingeschränkt. In Gefahrensituationen ist es je- 
doch von besonderer Bedeutung, dass ein möglichst großer kooperativer Hand- 
lungsspielraum zur Unfallvermeidung zur Verfügung steht. Daher wird bei den 
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in dieser Arbeit untersuchten Algorithmen auf Entkopplungsannahmen verzichtet. 



In Kapitel 6.4 werden die Algorithmen hinsichtlich ihrer Leistungsfähigkeit mit 
einem Entkopplungsverfahren verglichen. Ein weiteres Argument gegen Entkopp- 
lungsannahmcn ergibt sich aus juristi.schcn Überlegungen: Ein Fahrerassistenz- 
system sollte erst zum spiitestm()glichen Zeitpunkt eingreifen, sodass die Fahrer 
nur dann überstimmt werden, wenn ein Unfall anders nicht mehr zu verhindern 
ist iWinnerOOal . Ein entkoppeltes Planungsverfahren, das bestimmte Handlungs- 
kombinalionen ausschließt und daher in manchen Fällen einen früheren Eingriff 
zur Kollisionsvermeidung erfordert, kann diese Anforderung nicht erfüllen. 

Der Entwurf eines Verfahrens zur kooperativen Bewcgungsplanung in Gefahrensi- 
tuationen kann entweder ausgehend von Bahnplanungsalgorithmen für mehrere 
Roboter oder au.sgehend von Bcwegungsplanungsverfahren für Einzelfahrzeugc 
erfolgen. Viele Bahnplanungsalgorithmen für mehrere Roboter können Dynamik- 
begrenzungen nicht in dem Maße berücksichtigen, wie es bei der kooperativen 
Kollisionsvcrmeidung im Straßenverkehr erforderlich ist. Zu dieser Gruppe von 
Algorithmen gehören die entkoppelte Bahn- und Geschwindigkcitsplanung und 
die Roadmap-Koordinierung (vgl. Abschnitte 2..^.4 und 2.^.b) . Reaktive Verfah- 



ren ohne Vorausplanung, darunter viele Potenzialfeldansätze und die meisten Ar- 
beiten zur kooperativen Formationsregelung, erscheinen für dynamische Fahrzeu- 
ge mit höheren Geschwindigkeiten weniii izeeiunet. Navigationsfunktionen lassen 
sich nur für eingeschränkte Umgehungen effizient berechnen. Eine Verallgemeine- 
rung auf schwierigere Szenarien mit mehreren Fahrzeugen und Hindernissen hat 
wenig Aussicht auf Erfolg, da die Berechnung einer solchen Navigalionsfunkli- 
on die gleiche Rechenkomplexität hätte wie die vollständige Lösung des Bewe- 
gungsplanungsproblems ILaValleüöl Kapitel 8]. Neben der prioritätsbasierten Pla- 
nung als weiteres Entkopplungsverfahren verbleiben im Wesentlichen noch die 
gemischl-ganzzahlige lineare Programmierung und die RRT-Planung im gemein- 
samen Konfiguraiionsraum als mögliche Ansatzpunkte. Im folgenden Abschnitt 
wird ein Verfahren vorgestellt, das mit der RRT-Planung verwandt ist. Es basiert 



ebenfalls auf einer Baumstruktur, ist jedoch nicht randomisiert. Abschnitt 5.4 be- 
handelt die Anwendung der gemischt-ganzzahligen lineiu*en Programmierung auf 
die kooperative Kollisionsvermeidung. 

Beim Versuch, Bcwegungsplanungsverfahren für Einzelfahrzeuge auf den koope- 
rativen Fall zu erweitern, gehl oft die Echlzeitfähigkeit verloren. Der Aufwand 
vieler Algorithmen wächst exponentiell mit der Dimension des Konfigurations- 
raums, nach ( |5.2f also exponentiell mit der Anzahl der Fahrzeuge IjLatombeO 1 1 
Abschnitt 8.2.2J. Gitterbasierte Verfahren, die den diskretisierten Konfigurations- 
oder Zustandsraum explizit konstruieren, sind für mehrere Fahrzeuge nicht mehr 
praktikabel. Einer der wenigen Ansätze, die relativ gut mit der Anzahl der Fahr- 
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zeusic skalieren könnten, ist die Methode der ekistischen Bänder. Sie wird inlAb- 



schnill auf die kooperative Kollisionsvermeiduiig angewandt. 



In dieser Arbeit werden mehrere alternative Algorithmen untersucht und vergli- 
chen. Der Gnind für diese Vorgehensweise ist einerseits, dass Bevvegungspla- 
nungsvertahren zur kooperativen Kollisionsvermeidung mehrerer Fahrzeuge in der 
Literatur kaum untersucht wurden und somit keine unmittelbare Verglcichsgrund- 
lage zur Bewertung solcher Verfahren verfügbar ist. Andererseits ist zu erwarten, 
dass die verschiedenen Verfahren unterschiedliche Stärken und Schwächen auf- 
weisen, sodass die Auswahl eines Verfahrens entsprechend der betrachteten Ver- 
kehrssituation oder die Kombination mehrerer Verfahren sinnvoll sein könnten 



(vgl. Kapitel 6.4 und 7.2 



5.3 Baumsuche mit Vorberechnungen 
5.3,1 Entscheidungstheoretische Formulierung 

Die Cirundidee für den Baumsuchaluorithmus besteht darin, die statistische Ent- 
Scheidungstheorie auf das Problem der Bewegungsplanung anzuwenden. In der 
statistischen Entscheidunsistheorie werden die verfüiibarcn Handlungsaltcrnativen 
anhand einer Verlustfunktion bewertet, um die optimale Mandlung zu ermitteln 
| Bamberg()S| : 

EL(a|ei') - ^ L{x)P{.r\a. ev) (3.3) 

.r 

a* = argmin EL(r/[rr) (5.4) 

acA 

Dabei bezeichnet A die VerlustfunktionQr/ die Handlungsaltcrnativen, x den Sys- 
temzustand nach der Ausführung von a, ev die verfügbare Information (Evidenz), 
EL den erwarteten Verlust und u* die optimale Handlung. Die bedingte Wahr- 
scheinlichkeil P{x\a. tv) beschreibt die Wahrscheinlichkeit, dass bei Ausführung 
von Handlung o unter der Information < v der Zustand ./• eintritt. 

In dieser Arbeit wird jedoch aufgrund der Problemkomplexität der kooperadven 
Bewegungsplanung auf eine probabilisti.sche Modellierung verzichtet. Der nach- 
folgend vorgestellte Algorithmus kann zwar prinzipiell auch auf die probabilisti- 
sche Formulierung angewandt werden. Jedoch steigt der Rechenaufwand bedingt 
durch die unsichere Zustandsbeschreibung in i j5.3| > stark an. Im deterministischen 

'Ein äquivalentes Problem erhält man beim Einsatz einer Nutzenfunktion U — —L und Ma.\imie- 
rung des erwarteten Nutzens RIJ. 
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Fall kann auf die Übcrgangswahrschcinlichkcit P(x|a, ev) verzichtet werden, und 



wobei f{a,ev) das delerminislische Systemmodell darslelll. 

Bei der Anwendung dieses Kalküls auf das Problem der kooperativen Fahrma- 
növerplanung können bekannte Fahrzeugmodelle als Systemmodell dienen. Die 
Verlustfunktion kann Kriterien wie Kollisionen, Verkehrsregeln und Fahrkomfort 
abbilden. Eine Herausforderung ist hingegen die Strukturicrung der Ilandlungsal- 
ternativen: Erstens muss jedes Fahrzeug nicht nur zu einem Zeitpunkt eine Hand- 
lung auswählen, sondern die optimale Handlung kann sich mit der Zeil ändern, 
und zweitens ist die Kombination der Handlungsallernativen mehrerer kooperie- 
render Fahrzeuge zu berücksichtigen. Daher erhält man Sequenzen von koopera- 
tiven Handlungen, die sich in einem Baum anordnen lassen. Techniken zur effi- 
zienten Suche in einem solchen Baum werden in den nachfolgenden Abschnitten 
beschrieben. 

Ein großer Vorteil dieser Vorgehensweise ist die explizite Modellierung der Fahr- 
zeuge und der Verlustfunktion. Dadurch kann die exakte Einhaltung von Beschrän- 
kungen wie der nichlholonomen Kinematik und der Fahrzeugdynamik gewährleis- 
tet werden, und die Ergebnisse können direkt auf die zu Grunde liegende Verlusl- 
funktion zurückgeführt werden. Sie bilden damit eine Referenz für andere Algo- 
rithmen zur kooperativen Bewegungsplanung. 

5.3.2 Modellierung 

Der Baumsuchalgorithmus verwendet explizite Modelle für Geometrie. Kinema- 
tik, Dynamik und Handlungsoptionen des Fahrzeugs sowie für das Verluslfunklio- 
nal. Es wurden vergleichsweise einlache Modelle gewählt, weil bei der kooperati- 
ven Verhaltensentscheidung lediglich ein grober Plan ermittelt wird, der anschlie- 
ßend auf Einzelfahrzeugebene unter Verwendung detaillierterer Modelle verfeinert 
werden kann. Sollte eine genauere Planung auf kooperativer Ebene gewünscht 
werden, wird lediglich der Auslausch des entsprechenden Modells erforderlich. 
Der Baumsuchalgorithmus kann prinzipiell mit beliebigen Modellen verwendet 
werden. 

5.3.2.1 Fahr/eugkinematik und -dynamik 




EL{a\ev) - L{f{a.ev)), 



(5.5) 



Wie bereits in Abschnitt 5.1 erläutert, ist die geometrische Konfiguration eines 
Fahrzeugs durch q, = (.Xj, i/,-, <?i)^ gegeben. Für ein Modell der Fahrzcugdyna- 
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mik sollte zumindest die Liingsgeschwindigkeit velj als weitere Zustandsvariable 
hinzugenommen werden, sodass man den Zustandsvektor Xi = (xi^yi, (j>i, i>eli)^ 
erhält. Unter der Längsgeschwindigkeit wird die Momentangeschwindigkeil in 
Richtung der Fahrzeugorientierung öi verstanden. Der Zustandsraum wird mit Xi 
bezeichnet. Den Zustand x einer Gruppe von M Fahrzeugen erhält man durch 

rp '"IT rr« 

Konkatenation der einzelnen Zustandsvektoren: x = (xi , . . . . x^^) . Der gemein- 
same Zustandsraum A* ist das kartesische Produkt der einzelnen Zustandsräume: 

Automobile haben eine nichtholonome Kinematik, d.h. sie können sich im Konfi- 
gurationsraum nicht in beliebige Richtungen bewegen. Vielmehr muss die instan- 
tanc Bcwcsiungsrichtunii mit der Oricnticruny der Räder übereinstimmen. Den- 
noch sind prinzipiell alle Konfigurationen aus dem dreidimensionalen Raum Qi 
erreichbar. Die nichtholonome Fahrzeugkinematik lässt sich vereinfacht durch 
folgendes Zustandsraummodell beschreiben (vgl. iLaValleü6ll , IIChoset051 Ab- 
schnitt 12.5.61): 



\veUj 



[ veli ■ cos 0i\ 
velj ■ .sin Oj 
0 
0 



\ 



/ 



+ 



/ 



0 

ü 



\ 



veli 



tan g; 



v 



tlCC, 



(5.6) 



/ 



Der erste Summand auf der rechten Seite von < |5.6^ beschreibt die Systemdyna- 
mik, der zweite die Eingangsgrößen. Dabei bezeichnet a; den Lcnkwinkel, /, den 
Radstand und «rc, die Längsbeschleunigungj^] Der Lenkwinkel ist der Winkel 
zwischen Vorder- und Hinterradstellung, der Radsland der Abstand von Vorder- 
und Hinterachse. Längs- und Querbeschleunigung sind die Beschleunigung des 
Fahrzeugs parallel bzw. senkrecht zu seiner Orientier ung o,. D er Bezugspunkt 
(■'■''• .'yj')^ für ( 15 .61 liegt in der Mitte der Hinterachse ( Abb. 3.l| . Mit dem sonst 
als Referenzpunkt verwendeten geometi'ischen Mittelpunkt (.r,, y, )^ hängt er wie 
folgt zusammen, wenn den Abstand der Hinterachse vom Fahrzeugmillelpunkt 
bezeichnet: 





(5.7) 



Das Fahrzeugmodell ( |5.6| ) gehört zu den Einspurmodellen, da anstatt der bei- 
den Räder jeder Achse jeweils nur ein virtuelles, in der Fahrzeugmitte liegen- 
des Rad modelliert wird. Detailliertere Ein- und Zweispurmodelle finden sich 
in IZomotor87ilvHundelshausenü8IIMit.schke(J4l . Auch Sattelzüge und Anhänger 
können modelliert werden IILaValleQ6[|ChosetQ5]|Laumond98| . 



-Zur Vereinfachung der Notation wird die Abhängigkeit der Zustandsgrößen von der Zeit t nur dann 
cxpii7it angegeben, wenn mehrere Zeitpunkte auftreten. 
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ueli 



Abbildung 5.1: Notation fiir das Fahrzeugmodell l |5.6^ . 



Das Fahrzeugmodell ( |5.6| lässi sich analytisch integrieren, wodurch eine effizi- 
ente Berechnung des Zustands x(^ I At), Af>0, ausgehend vom Zustand x(i) 
möglich wird (vgl. auch |Latombe9 1 1 Abschnitt 9.6. IJ, flydBrcK-k 1()[| ): 

veli{t + At) = veliit) + acciit) ■ At (5.8) 
Mt+At) = Mt) f ^^^^f^-("f'/*(i) » l ■ acCiit) ■ At) . At 

' i 



y?{t + At) 



{t) + (veliit) + ^.a.cci{t)-At)-At- Hm(Pi(t), ai(/)-0 
- tJwhF) • (cos0^(i + At) - cos 0,(0) , ^ Ü 



Hierbei sind die Eingangsgrößen acc,(<) und als konstant auf dem Intervall 
[t, i + At] angenommen. Diese Gleichungen können durch Differenzieren nach At 
verifiziert werden. 

Die Fingangsgrößcn a, und arcj können nicht beliebig gewählt werden, son- 
dern müssen kinematische und dynamische Grenzen einhalten. Der Lenkwin- 
kel a,- ist durch die Fahrzeugkinematik i.d. R. auf ein symmetrisches hitervall 
[— ö,:,max^ <i^i,max| beschrankt. Diese Begrenzung hat zur Folge, dass ein Fahrzeug 
sich nicht an Ort und Stelle drehen kann, sondern einen Wendekreis von nicht ver- 
nachlässigbarem Radius benötigt. Zusätzlich begrenzt die Fahrdynamik die Quer- 
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beschlciinigung acci i^- Die Qucrhcschlcuniiiung bei Kurvenfahrt wird auch Zen- 
iripetalbeschleunigung genannt und hängt über die momentane Bahnkrümnuing k, 
mit dem Lenkwinkel zusammen lLatombe911 Abschnili 9.1.2J: 

o^^^^t,iat = «i ■ ^'cl^ (5.9a) 
tau o,- 

K» = — ^ (5.9b) 

Wenn die Querbcschlcunigung im Intervall (— accjjai.max! f"'' t,iai,maxj liegen soll, 
muss für den Lenkwinkel gelten: 

\ai\ < arctan(/i • Ki) = arctan "^''^ (5. 10) 

Insgesamt muss der Lenkwinkel folgende Ungleichung erfüllen: 

Iii . ^ • ^"•^■/.lal.niax 1 , . 

Ptl |tV2,max, arclaii — ^ | (,^.11) 

Bereits bei mittleren Geschwindigkeiten ist i.d. R. die fahrdynamischc Beschrän- 
kung restriktiver als die kinematische. 

Die Längsbeschleunigung <u-c; ist ebenfalls auf ein Intervall [acc,-.niinT ö^'Q.max] 
beschränkt. Dabei kann «c-q,„„„<Ü als Bremsfähigkeit und ma,\ > C> als Be- 
schleunigungsfähigkeit des Fahrzeugs interpretiert werden. Die Beschleunigungs- 
fähigkeit hängt unter anderem von der Motorleistung und dem Luftwidersland des 
Fahrzeugs ab. 

Längs- und Querbeschleunigung sind nicht unabhängig voneinander /u betrachten, 
sondern müssen folgende Ungleichung erfüllen IZ o m o to r 8 7 1! S c h m i d tü 6 1 : 



Dieses vereinfachte Modell wird als Kamm "scher Kreis bezeichnet, da der Be- 
schleunigungsvektor innerhalb eines Kreises mit Radius ^/y • li<^gl l |Abb. 5.2) . 



Darin ist ^ 9.8 m/s^ die Erdbeschleunigung und //, < 1 der HaftreibungskoefH- 
zient zwischen Reifen- und Stralk^noberfläche. Letzterer variiert mit verschiedenen 
Faktoren wie StraBenbelag, Feuchtigkeit und Reifentyp | |Burg(.)9l. Der Reibungs - 



koefhzicnt ist daher im Allgemeinen orts- und z.eitvariant (siehe Abschnitt 3.3.2| . 



Auch die Beschleuniuuniis.schrankcn 

rt/Ti min'» ßccj max, fl'^f'jjat.max J>ind bei genau- 
er Betrachtung nicht als Konstanten anzusehen, sondern als Funktionen verschie- 
dener Einflussfaktoren wie etwa Geschwindigkeit und Beladung des Fahrzeugs. In 
dieser Arbeit wird angenommen, dass die benötigten Daten aus dem gemeinsamen 
Lanebild bekannt sind. 
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|acc,-,min| I H 

Abbildung 5.2: Veran schau 1 ich ung der Handlungsmenge Ai im Raum der fahrdy- 
namisch zulässigen Beschleunigungsvektoren. 



5.3.2.2 Handlungen 

Die Handlungsmöglichkeiten eines Fahrzeugs lassen sich zunächst über die Ein- 
gangsgrö(3en a,, accj des Fahrzcugmodells ( |5.6f charakterisieren. Die Beschrei- 
bung einer Handlung a, beinhaltet somit ein Paar [ai^acci). Innerhalb der kine- 
matischen und dynamischen Grenzen ergibt sich ein zweidimensionales Kontinu- 
um von Handlungen. Für den Baumsuchalgorithmus muss daraus eine endliche 
Menge Ai von möglichen Handlungen ausgewählt werden. 

Es ist bekannt, das extreme Handlungen wie maximales Bremsen oder maxima- 
ler Lcnkeinschlag in eine der beiden Richtungen optimal sind, wenn ein einzelnes 
Fahrzeug die Kollision mit einem einzelnen bewegten Hindernis vermeiden soll 
llSchmidt06l lHillenbrand07l iBuschO.Sj . Dies gilt nicht mehr, sobald mehrere ko- 



operative Fahrzeuge beteiligt sind, oder auch nur die Grenzen der Slraßenfläche 
berücksichtigt werden sollen. Dennoch kann man vermuten, dass extreme Hand- 
lungen auch für die kooperative finfallvermeidung eine sinnvolle Wahl sind, die 
selbst bei grober Diskretisierung noch einen großen Handlungsspielraum ermög- 
licht (vgl. hierzu auch Abschnitt 5.3.7^ . 



Auf der Grundlage dieser Überlegungen wurden die folgenden Handlungen defi- 
Ahb. 5.2^ : ^ 



niert ( 



1 . Geradeausfahrt mit konstanter Geschwindigkeit: = (0, 0) 

2. Geradeausfahrt mit maximaler Bremsverzögerung: a^"^*^ = (ü, acci^^m) 
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3. maximales Ausweichen nach links mit konstanter Längsgeschwindigkeit: 
mit al'^^' = min {rv/^max, arctan ^' ' } gemäß <(57TT) 



4. maximales Ausweichen nach rechts mit konstanter Längsgeschwindigkeit: 

5. kombiniertes Bremsen und Ausweichen nach links: 

brake.left / brake,left 1 



mit a^'-''^-^'^" - min arctan ' '"'^^^^^'" ^^ | 

gemäß ((57TT) und l(57nj 



6. kombiniertes Bremsen und Ausweichen nach rechts: 

brake.riglil _ / brakcright i v • brakc.hght _ brake.left 

7. Geradeausfahrl mit maximaler Längsbeschleunigung: af^ — (Ü, acci^max) 

Die Inslanziierung dergleichen Handlung in verschiedenen Fahrzeugzuständen re- 
sultiert i. d. R. in unterschiedlichen Zahlenwerien für Lenkwinkel und Beschleuni- 
gung, da die im vorigen Abschnitt hergeleiteten fahrdynamischen Beschränkungen 
von O j und acc, vom Fahrzeugzustand abhängig sind. Diese Beschränkungen kön- 
nen sich auch während der über ein Zeitintervall fortgesetzten Ausführung einer 
Handlung ändern. 

Neben diesen fahrdynamisch charakterisierten Handlungen lassen sich auf einem 
etwas höheren Abstraktionsniveau auch Handlungen definieren, die von IJmge- 
bungsinformation abhängig sind. Sinnvoll erscheinen bcispiclswci.se Handlungen, 
die ein Fahrspurfolgeverhalten beschreiben: 

8. Spurfolgen mit konstanter Geschwindigkeit: f,^'»"'^ *^""*' = (oj''"'^, 0), wobei der 
Lenkwinkel a'/"^ unter Einhaltung von i )5 . 1 1 1 so gewählt wird, dass das 
Fahrzeug seiner aktuellen Fahrspur folgt 

9. Spurfolgen mit maximaler Bremsverzögerung: 

^lanc.brakc _ ^^^lanc ^^^lanc.brakc^ 



lancbrakc J // \o / vti- • tana'^"'\ 

mit «cr^"'''"^"*'" = max < rtrri,m.n, - d Uü ■ Oef - '-) 

gemäß ((5]2) und ( pTH) 
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Denkbar sind ferner Handlungen, die einen Spurwechsel des Fahrzeugs beschrei- 
ben IIResendelOI . 

Wenn eine Handlung a, beginnend im Zustand Xj(^) über ein Zeitintervall At aus- 
geführt wird, ergibt sich ein neuer Fahrzeugzustand x,(f + Af). Dieser Vorgang 
lässt sich mit der Zustandsübergangsfunktion beschreiben: 

x,(i + A<) = /i(x,(/),ai,A<) (5.13) 

Nachdem die Handlung a, zu einem Paar (a^, acc,-) instanziiert wurde, kann die 
Zustandsübergangsfunktion mittels der integrierten Gleichungen ( |5.8| des Fahr- 



zeugmodells sowie der Transformation <\5.7\ effizient berechnet werden. Die Tra- 
jcktoric [t, t + A^] — > Xi im Zustandsraum wird mit '-;j(xj(^), ßj, At) bezeichnet. 

Eine kooperative Handlung von M Fahrzeugen kann als Vektor von Einzelhand- 
lungen geschrieben werden: a — («i, . . . , Oj\j)^ mit a, G Ai für i = 1, . . . , M. Die 
Zustandsübergangsfunktion kann auf den gemeinsamen Zustandsraum und auf ko- 
operative Handlungen erweitert werden, x(/ + At) = /(x(f). a, A/), sodass die 
Einschränkung auf den Konfigurationsraum eines einzelnen Fahrzeugs die indivi- 
duelle Zustandsübergangsfunktion ergibt: = Entsprechend kann auch die 
Trajektorie 7(x(#), a, A^) : [t,t + At] — > X der kooperativen Fahrzeuge definiert 
werden, sodass 7 = (71 , . . . , 7a/ )^ gilt. 



5.3^.3 Verlustfunktional 

Das Verlustfunktional L wird eingesetzt, um Präferenzen über geplante Trajek- 
torien 7 auszudrücken. Einer Trajektorie 7 : [/min,^max] ^ wird ein nicht- 
negativer Verlust ^(7) > 0 zugeordnet. Die Trajektorie 7 wird genau dann ge- 
genüber 7 bevorzugt, wenn £(7) < L{'^). Verglichen werden hierbei nur Trajek- 
torien mit identischem Definitionsbereich \tm\n, ^max] innerhalb des Planungshori- 
zonts (0 < tnMn < ^max < 'h)- D«is Verlustfunktional macht lediglich relative Aussa- 
gen über Trajektorien, sein absoluter Wert ist nicht von Bedeutung. 

Das Verlustfunktional wird als additiv über Trajektoriensegmente angenommen: 

Für beliebige /min < < ^max, 7 : [^min,^m| ^ A", 7 : [/m,fmaxl X, 

7c : [^m.n,^max] ^ mit ^^{t) = ^[t) für alle / e [^min^^m] und 7^.(^) = 7(0 
für alle t € [f„„ imax] gelte L(7,) = £(7) + 1(7). 

Entsteht die Trajektorie durch die Ausführung einer kooperativen Handlung a, so 



erhält man mit Hilfe der Abbildung 7(x,a, Af) aus Abschnitt 5.3.2.2 eine Ver- 
lustfunktion L(x, a, At) := Z/(7(x, a, At)) als Funktion des Zustands und der ko- 
operativen Handlung. Entsprechendes gilt auch für die einzelnen Summanden des 
Verlustfunktionals, die nachfolgend definiert werden. 
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Das Verlustfunktional setzt sich additiv aus mehreren Termen zusammen, welche 



die in Abschnitt >. 1 aufgeführten Anforderungen widerspiegeln: 



L(7) - L^""(7) + i:-°'''(7) + L'^'^'^h) + L^"''(7) + I'""''°'(7) (5-14) 

Das Funktional L'^^^^'y) bewertet Kollisionen zwischen kooperativen Fahrzeugen 
innerhalb des Trajektoriensegments 7. Eine einfache Formulierung addiert für jede 
Kollision zweier Fahrzeuge q, cj einen konstanten Strafterm Lq"" ;» 0: 

Lf'-S,,j{y^r(j^t)dt, (5.15) 

wobei 

kjili,lj^t)^6^j{-fiit)rfj{m-{^-^jili{t-eco»),^ (5.16a) 

'^..(q^^q.)-Jl fallsa(q,)na,(q,)/0. ^'-^^^^ 

Der Faktor ^fj(qj, qj) ist 1 genau dann, wenn die Schnittmenge der Fahrzeug- 
polygone Qi und Qj in den Konfigurationen q, bzw. q^ nicht leer ist. Der zwei- 
te Faktor in ( |5.16a^ bewirkt, dass der Verlust lediglich am Beginn der Kollision 
für die infinitesimale Zeitspanne ^coii > 0 angerechnet wird. Ob im Anschluss 
daran weiterhin eine geometrische Überlappung der Fahrzeugpolygone vorliegt, 
spielt für das Verlustfunktional keine Rolle. Somit ist der Verlust im Wesentlichen 
proportional zur Anzahl der Kollisionen. Andernfalls könnte es passieren, dass 
mehrere Kollisionen mit kurzer geometrischer Überlappung der Fahrzeugpolygonc 
günstiger bewertet werden als eine Kollision mit länger andauernder Überlappung. 
Damit dieser Faktor auch für f — ► f^jn wohldefiniert ist, wird für t < t^^ formal 
7/(0 := 7t(^min) gesetzt. 

Zur Berechnung von <^;,j(qi, Qj^ 0 wird ein Test für die Überlappung zweier Po- 
lygone benötigt. Implementiert werden kann dies über geometrische Algorithmen 
IIQ'Rourke94l . Aufgrund des Rechenaufwands sollte diesem Kollisionstest ein ein- 
facher abstandsbasierter Test vorgeschaltet werden. Die Überlappung zweier Poly- 
gone kann ausgeschlossen werden, falls der euklidische Abstand ihrer Mittelpunk- 
te größer ist als die Summe ihrer Umkreisradien. Nur wenn die Mittelpunkte einen 
geringeren Abstand haben, muss der Polygon-Kollisionstest durchgeführt werden. 
Das Integral in ( |5.15| wird durch eine diskrete Summe konservativ approximiert, 
sodass für jede geometrisch detektierte Kollision mindestens der Verlust Ly"" ad- 
diert wird. 
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Schließlich wird die Kollisionsbewcrtung über alle Paare von Fahrzeugen aufsum- 
miert: 

i = l 7 = H 1 

Mit dem beschriebenen Modell wird die Anzahl der Kollisionen minimiert. Ein 
weiterführendes Ziel ist die Minimierung der Kollisionsschwere. Hierzu kann in 
( j5. 15} anstelle des konstanten Faktors Lq'" ein Maß für die Kollisions.schwerc ver- 
wendet werden: 

^<j'n('>/-7,.0'!^K,(7.1,,./)d/, (5.18) 

■ rnin 

Eine aussagefähige Bewertung /.^"''['(V-^.,. - /) für die Schwere einer Kollision 
muss die physikalischen Vorgänge beim Aufeinanderprallen zweier Fahrzeuge in 
ausreichender Näherung berücksichtigen. Die Verlelzungsschwere bei Fahrzeug- 
insassen hängt wesentlich von der Beschleunigung ab, die auf den menschlichen 
Körper einwirkt. Diese Beschleunigung wird vor allem durch zwei Faktoren be- 
stimmt: die relative Aufprallge.schwindigkeit der beiden Fahrzeuge und die Defor- 
mationsstrukturen der KiU^osserie. die so genannte Knautschzone. 

In dieser Arbeit wird ein stark vereinfachtes Modell verwendet, um die Berück- 
sichtigung der Kollisionsschwere bei der Bewegungsplanung demonstrieren zu 
können. Das Modell beinhallet die Abhängigkeit der Kollisionsschwere vom Auf- 
prallwinkel und unterscheidet sich dadurch von alternativen Kriterien wie der Re- 
lativgeschwindigkeit und der Aufprallenergie ||(ilascrlO| . Für eine Ausgestaltung 
der Parameter und eine Verfeinerung des Modells wären umfangreiche Daten aus 



der Unfallforschung erforderlich |Diggcs() 1 [rKramer()91|Burg09}[WöödÖ2l 



Das hier verwendete Vcrlustfunktional basiert auf dem Feder-Masse-Modell für 
Frontalkollisionen aus iMooiOOl . Damit ist im Gegensatz zum physikali.schcn Mo- 
dell eines inslantanen Stoßes eine Abschätzung der auftretenden Beschleunigun- 
gen möglich. 

Zusätzlich wird die Abhängigkeit von der Richtung des Aufpralls berücksichtigt, 
um beispielsweise zwischen frontalen und seitlichen Kollisionen differenzieren zu 
können. Hierzu werden aus der geometrischen Konstellation der beiden Fahrzeuge 
die Stoßrichtung u und die Aufprallwinkel .ij bestimmt i Abb. 5.3) . 



Die Anfangsgeschwindigkeiten in Stoßrichtung ergeben sich durch die Projektion 
vel\^ = veli- (cüi,9j Hiwöi) ■ • (5.19) 



^Bei den folgenden Variablen wird zur Vereinfachung der Notation die Abhängigkeit von (li, 7j , t) 
nicht explizit angegeben. 
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Damit erhält man nach IMooiüOI die folgenden Maximalbeschleunigungen wäh- 
rend der Kollision: 

Darin ist mj die Masse des Fahrzeugs r, und Ki{ßi) die Steifigkeit der Fahrzeug- 
karosserie am Punkt des Aufpralls. Das Verlustfunktional bewertet letztlich die 
Verletzungsschu ere, die sich als monoton steigende Funktion L^'*"'" der Beschleu- 
nigungen annähern lässt: 

L^toili. Ij. i) = Lf'^iacci,^, ßi) + Lf^{accj,^, ßj) + L^" (5.21) 

Die Aufprallwinkel werden ebenfalls miteinbezogen, da neben der Beschleuni- 
gung weitere Faktoren wie etwa die Findringtiefe bei einem Seitenaufprall zur 
Vcrietzungsschwerc beitragen können. Die Konstimte Lq''"'" "^'t ^ < Lo""*" < //q''" 
bewirkt, dass auch Kollisionen mit geringen Relativgeschwindigkeilen wenn im- 
mer möglich vermieden werden. Zusätzlich könnte es sinnvoll sein, die Restge- 
schwindigkeiten nach dem Stoß zu berücksichtigen, da die Fahrzeuge durch den 
Unfall außer Kontrolle geraten und weitere Kollisionen verursachen könnten. Die 



.2 



T]U} TTli 

Kiißi) Kjißj) {mj rrij) 
{Ki{ßi)-\-Kj{ßj))mimj 

w • {nii + m, ) 



(5.20a) 
(5.20b) 

(5.20c) 
(5.20d) 
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Bewertung der Kollisionsschwere wird analog zu ( [5. 17| über alle Paare von ko- 
operativen Fahrzeugen aufsummiert. 

Der zweite Term des Verlustfunktionals ( )5. 14) bewertet Kollisionen mit Hinder- 
nissen. Unter Hindernissen werden alle Objekte verstanden, mit denen ein koope- 
ratives Fahrzeug nicht kollidieren soll, mit Ausnahme der anderen kooperativen 
Fahrzeuge, die bereits durch den oben beschriebenen Term L*^''" abgedeckt sind. Es 
kann sich um nicht kooperative Fahrzeuge, weitere Verkehrsteilnehmer wie Fuß- 
gänger und Radfahrer, geparkte Fahrzeuge, Baustellen oder sonstige Hindernisse 
auf der Fahrbahn, sowie Häuser, Bäume und andere Objekte am vStraßenrand han- 
deln (vgl. [Ahschniti 3.4) . Von jedem der Av,bst relevanten Hindernisse muss eine 
geeignete Geometrie- und Positionsbeschreibung verfügbar sein. In dieser Arbeit 
wird eine Repräsentation durch Polygone in der Straßenebene gewählt, die für das 
j-te Hindernis mit Qf^^{-,j^'^^{t), t) bezeichnet wird, t e [tmm, ^max]- Für stehende 
Hindernisse ist 7y''*'(i) = 7^''*' konstant. Für bewegte Hindernisse muss die Tra- 
jektorie 7j^^'(0 'ils bekannt vorausgesetzt werden. Sie kann beispielsweise durch 



(5.22b) 



geeignete Prädiktionsverfahren geschätzt werden, vgl. Abschnitt 3.5.1 Im nach- 
folgenden Planungsprozess ist eine Unterscheidung zwischen stehenden und be- 
wegten Hindernissen nicht erforderlich. 

Das Verlustfunktional L^^J' für die Kollision von Fahrzeug i mit Hindernis j kann 
auf ähnliche Art und Weise definiert werden wie L;**!': 

Lf^'-S^i^ulf'^t^dt (5.22a) 

,-o...o. , . _ |0 falls n.(q..) n n-(qr • 0 - 0 ,2c) 
\j (q.,q, ,t)-<^^ fallsQ,(q,)nnf' (qf ,f)^0 ^""^'^^ 

X,obs.(^) = ^ Vt^i^i) (5.22d) 
1=1 j=i 

Mit dieser Formulierung wird die Anzahl der Kollisionen zwischen kooperativen 
Fahrzeugen und Hindernissen minimiert. Wiederum kann eine verfeinerte Model- 
lierung vorgenommen werden, um eine Minimierung der Kollisionsschwere zu 
erreichen. Zusätzlich zu den oben diskutierten Aspekten ist insbesondere die Hete- 
rogenität der Objekttypen zu beachten, die einen erhöhten Aufwand beim Entwurf 
der Kollisionsbewertung zur Folge hat: Offensichdich sollte die Kollision mit ei- 
nem Fußgänger anders bewertet werden als beispielsweise mit einer Betonmauer. 
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Eine stark vereinfachte Modellierung dieses Zusammenhangs lässt sich über eine 
vom Objekttyp abhängige Gestaltung des Faktors Lf'^^ in (|5]22ä} erreichen. Eine 



detailliertere Ausgestaltung des Verlustfunktionals L"^*"" wird in dieser Arbeit nicht 
behandelt. 

Ein weiterer Tcrm berücksichtigt die Einschränkungen, die durch den Straßenver- 
lauf bedingt sind. Das Verlassen der Straßenfläche wird durch das Verlustfunktio- 
nal U''""^ bestraft: 



niax 

road 



i^r(7.)= / L^rhi{t))dt (5.23a) 
(X.) - r , . ^'^""'^ ^ (5.23b) 



^;^^{ih{qi).veli) sonst 

.V/ 



f-1 



Zur Auswertung dieses Funktionais wird geometrisch überprüft, ob die Fahrzeug- 
fläche n,(q,:) in der gesamten Straßenfläche U, t/?oafi.s enthalten ist, die sich 
als Vereinigung der einzelnen Straßen ergibt. Dieser Test kann mit geometrischen 
Algorithmen durchgeführt werden ISchmitt96l . Die Funktion U°lf {üj , veli) in 
( |5.23b^ beschreibt in erster Linie die Eigenschaften des Straßenrands und der Flä- 
che, auf die das von der Straße abgekommene Fahrzeug gelangt. Je nach ihrer 
Beschaffenheit kann das Verlassen der Straße mit einem hohen oder vergleichs- 
weise geringen Risiko verbunden oder aber völlig unmöglich sein. Als Beispiele 
für diese Fälle seien genannt: 



• Eine Mauer oder Leitplanke macht das Verlassen der Straße unmöglich. Tra- 
jektorien, die diese Einschränkung verletzen, müssen daher durch einen ho- 
hen Strafterm von der weiteren Betrachtung ausgeschlossen werden. 

• Ein hohes Risiko für die Fahrzeuginsassen besteht bei bewaldetem Straßen- 
rand oder bei einer steilen Böschung. 

• Dagegen stellen Wiesen oder Felder ein geringeres Risiko dar, sodass unter 
Umständen das Verlassen der Straße gegenüber einer Kollision mit einem 
anderen Fahrzeug vorzuziehen ist. 

Des Weiteren ist der Verlust beim Verlassen der Straße auch von der Geschwindig- 
keit des Fahrzeugs abhängig. Feste Straßenbegrenzungen können alternativ auch 
mit dem Funktional L"^"' bewertet werden. Ebenso wird für einzelne am Straßen- 
rand stehende Hindernisse, wie etwa Laternenmasten, auf L"*"*' zurückgegriffen. 
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Ein weiterer Term kann zur Bewertung der Ziel- und Regelkonformität der 
Fahrzeughandlungen eingesetzt werden. Aus dem Fahrtziel können Zwischenzie- 
le in Form der zu fahrenden Route abgeleitet werden. Ein Verlust tritt dann ein, 
wenn von der geplanten Route abgewichen wird. Außerdem sollten die Handlun- 
gen soweit möglich den geltenden Veikehrsiegeln entsprechen. Die wichtigsten 
Verkehrsregel sind in diesem Zusammenhang das Rechtsfahi^gebot und die Vor- 
fabrtsregehi. Bin Verstoß gegen die Verkehrsregeln kann ebenfalls mit dem Ver- 
lustfunktional bewertet werden. 

In dieser Arbeit wurde der Term auf der Grundlage einer Fahrtroutenbe- 
schreibung definiert. Die Route ist in Form einer Liste (ibnej,i, . . . , ianei^N^ ^) 
von Fahrspuren gegeben. Das Verlustfunktional bewertet nun das Verlassen der 
Route mit einem Strafterm > 0: 

I-r'hi) = /'"" LlfiMt)) dt (5.24a) 




falls n<(q<) c (12(Zancf,i) U . . . U ^2(^one<,^i^,,)) 
sonst 



(5.24b) 

\f 

^*^"'(7) = i;^r'(7i) (5.24c) 

i=l 

Mit dieser Formulierung kann die Zielerreichung und die Einhaltung des Rechts- 
fahrgebots geprüft werden, da die Fahrspurliste den Anforderungen des Rechts- 
fahrgebots genügt. Auf die Modellierung der Vorfahrtsregeln wird in dieser Arbeit 
verzichtet, da sie für die weiteren Untersuchungen nicht von zentraler Bedeutung 
sind. Falls keine Information über die beabsichtigte Fahrtroute vorliegt, werden 
alle Fahrspuren, die nach dem Rechtsfahigebot in Frage kommen, in die Liste ein- 
gefügt. 

Schließlich bewertet das Funktional L^^'""^''' die unmittelbaren Auswirkungen der 
Handlungen im Hinblick auf Fahrkomfort und Energieverbrauch. Damit wird si- 
chergestellt, dass Brems- und Ausweichmanöver nur dann ausgewählt werden, 
wenn sie zur Kollisionsvcrmeidung notwendig sind. Nicht notwendige Manöver 
werden vermieden, da sie unangenehm für die Insassen sind und einen zusätzlichen 
Hnergieverbrauch zur Folge haben. Die genannten Kriterien lassen sich in erster 
Näherung als Funktion Lf'"^^"U,'irr,. ??rr, i,,, ) der Längs- und der Qucrbeschleuni- 
gung beschreiben. Diese sind gegeben durch die zweite Ableitung der Trajektürie 
nach der Zeit, projiziert auf die Fahrtrichtung und ihre Normale. 



Oüpy tiyhioo inatotial 
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Abbildung 5.4: Wertebereiche der Terme des Verlustfunktionais. Alle Terme kön- 
nen im Optimalfall den Wert 0 annehmen, sehen aber bei einer Verletzung der 
jeweiligen Anforderung unterschiedlich hohe Minimal- und Maximalverlustc vor. 
Für eine korrekte Trajektoric 7 ist ^(7) < L\hr (siehe Abschnitt 6.3.3f . 



(5.25) 



1=1 



Die Vcrhälmissc der Wcrtcbcrcichc der einzelnen Terme in ( 5. 14| sind von ent- 
scheidender Bedeutung für die Eigenschaften der Trajcktorien mit minimalem Ver- 
lust. Zur Ausgestaltung der Wertebereiche kann bis zu einem gewissen Grad eine 
hierarchische Abstufung der einzelnen Kriterien vorgenommen werden. Kollisio- 
nen und das Verlassen der StraBe sollten wenn immer möglich verhindert wer- 
den. Bei einer Verletzung dieser Kriterien muss daher der Wert von L*"*^", L^^*' 
bzw. L'*'"'' größer sein als der größtmögliche Beitrag von L^''"' und I'-""'"^'. Die 
beiden letztgenannten Terme dienen lediglich dazu, eine Auswahl unter verschie- 
denen kollisionsfreien Trajektorien zu treffen. 

Wie weiter oben erläutert, ist das Verhältnis von L'^"'"' zu L*^"" und L"'^**' von der 
Beschaffenheit des StrafSenrands abhängig: Entsprechend der möglichen Befahr- 
barkeit der angrenzenden Fläche werden die Werte von entweder kleiner sein 
oder in einer ähnlichen Größenordnung liegen wie die von L*^"" und IJ'^'^^. Die Ab- 
stufung zwischen L*^"" und L"*^"" hängt von der Art des Hindernisses ab. Wenn die 
Kollisionsschwere modelliert wird, können für L^'^*"'" und den Hindernisterm die 
gleichen Modelle eingesetzt werden, sodass ihre Werte ohne Weiteres vergleichbar 
sind. 
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Die Beiträge von L^"*'' und z;,'-''^""''^' sollten in einer ähnlichen GröBenordnung lie- 
gen. Der Zielerreichung und der Einhaltung der Verkehrsregeln wird Vorrang ein- 
geräumt, wenn sie mit Beschleunigungswerten im Rahmen des Normalbereichs 
möglich ist. Andererseits ist ein Verlassen der geplanten Fahrtroute vermutlich we- 
nisier uravierend als ein extremes Ausweichmanöver. In einem solchen Fall sollte 
daher größere Werte annehmen können als /.^""'. 



Die gewählte Ausgestaltung der Wertebereiche wird in Abb. 5.4 veranschaulicht. 
Die genaue Gewichtung der einzelnen Tenne ist letztlich eine Frage der System- 
gcstaltung, die in dieser Arbeit nicht weiter behandelt wird. 



5.3.3 Konstruktion des Baums 



In Abschnitt .'S.3.2.2 wurde 1 landlungsnienge Ai eines Fahrzeugs einge- 
führt. Darauf aufbauend werden nun zeilliche Sequenzen von Handlungen 
definiert: Unter einer Handlungssequenz des Fahrzeugs r, wird eine Folge 

(«/,(). o;,i 1 ) mit (//ji, E Ai für A* = 0, . . . , T — 1 verstanden. Dabei wird 

die Handlung aj j^. während des Zeitintervalls (f/;.. #a | i] ausgeführt. Die Zeitpunk- 
te mit 0 = tQ<t^ < . . . < t-f = ih werden innerhalb des Planungshorizonts fest 
vorgegeben. Bei der Planung einer Handlungssequenz sind an diesen Zeitpunkten 
Entscheidungen über die nächste zu wählende Handlung vorzunehmen, daher w ird 
im Folgenden für U), . . . Jt i die Bezeichnung Entscheidungszeitpunkte verwen- 
det. Eine mögliche Vorgehensweise zur Festlegung dieser Entscheidungszeitpunk- 
te wird in lAbschnitt 6.4. 1.2l erläutert. 

Indem gleiche Anfangsabschnitte von Handlungssequenzen miteinander identifi- 
ziert werden, ergibt sich eine Baumstruktur Bj. Jeder Knoten /?, des Baums wird 
mit der zuletzt ausgeführten Handlung ni{ni), dem Fahrzeugzustand x,(//, ) und 
der Nummer A*(n,) des Entscheidungszeitpunkts annotiert ( Abb. 5.5) . Der Eltern- 



knoten von iij wird mit bezeichnet, die Wurzel von mit mot Die Funk- 

tion r/i(n,, (Ii) liefert den Kindknoten von /»,, der nach Ausführung von Handlung 
tti ausgehend von Xj(nj) erreicht wird. Mit der Zustandsübergangsfunktion /, gilt 
für die Fahrzeugzuständc: 



xf"' falls n, - rooti 

/i(Xj (7Jaj(n/)), o,:(?J./), <fc(n.) - <Jt(ni)-i ) sonst 

Xi{chi{ni,ai)) = /i(Xi(/Ji), «j, -ijt(n.)) (3.26) 

pa-{chi{ni,ü,)) - Ui, a,(c/i,(irtj, aj)) = , k{chi{ni, Ui)) - A.'(n,) I i 

Knoten mit gleicher Tiefe im Baum gehören zum gleichen Entscheidungszeit- 
punkt. Der Baum Bj hat Af Blätter, wobei .4, := |,4, | die Anzahl der Handlungen 
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und T die Anzahl der Entscheidungszeitpunkte ist. Zwischen den Blättern und den 
Handlungssequenzen besteht eine eindeutige Zuordnung. 

Bei der kooperativen Bewegungsplanung kann jede Handlung eines Fahrzeugs mit 
jeder Handlung der anderen Fahrzeuge kombiniert werden. Die Menge A der ko- 
operativen Handlungen ist gegeben durch das kartesische Produkt der einzelnen 
Handlu ngsmengen: 

A/ 

A= y. Ai (5.27) 
Kooperative Handlungssequenzen lassen sich in der Form 

Y) (5.28) 

schreiben, wobei {a\.k, ■ ■ ■ .fiM,k)^ ^ A für A- = 0 T — 1. Die Handlungs- 
sequenzen lassen sich in einem Baum ß anordnen ( Abb. 5.6) . Ein Knoten n 



des Baums wird mit der zuletzt ausgeführten kooperativen Handlung a(n) = 
(öi(n), . . . ,öA/(n))-^, dem kooperativen Zustand x(n) und der Nummer k{n) 
des Entscheidungszeitpunkts annotiert. Der Elternknoien von n wird mit pa{n) 
bezeichnet, die Wurzel von B mit wot. Die Funktion c/i(n, a) liefert den Kind- 
knolen, der mit der Ausführung von Handlung a erreicht wird. Analog zum Ein- 
zelfahrzeugbaum gilt für die Fahrzeugzustände: 

, , [x'*"*^' falls n = noo/ 

x(n) = { (5.29a) 
[/(x(pa(7i)), a(n), 4(n)-<fc(n)-i) sonst 

x(c/i(n,a)) = f{yi{ri),Si,tk(nH]-tkin)) (5.29b) 
pa{ch{n,a)) - n, a(c/j.(n,a)) = a, k{ch{n,a)) = A-(/?) + l (5.29c) 
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Abbildung 5.6: Baum B der kooperativen Handlungsscquenzen. 



Die Blätter von ß korrespondieren eindeutig zu den kooperativen Handlungssc- 
quenzen. Der Baum iiat .4^ Blätter, wobei .4 :— \A\. Im Folgenden wird ange- 
nommen, dass die Handlungsmengen der einzelnen Fahrzeuge gleichmächtig sind, 
^4o := 1^1 1 = . . . = |-4a/|. Diese Annahme ist für den Algorithmus nicht not- 
wendig, sie dient lediglich der Vereinfachung der Analyse. Wegen ( 5.27| ist unter 



dieser Voraussetzung .4 Aj^/ . Die Anzahl der Blätter lässt sich nun schreiben als 
= Aq' ' ^, sie ist also exponentiell in der Anzahl der Fahrzeuge. 

Fine alternative Konstruktion des Baums ergibt sich, wenn für jede Finzelfahr- 
zeughandlung njj; ein innerer Knoten eingefügt wird, anstatt die Handlungen für 
jeden Entscheidungszeitpunkt zu einer kooperativen Handlung zusammenzufas- 
sen. Der resultierende Baum ß' hat zwar mehr innere Knoten als jedoch e inen 
deutlich geringeren Verzweigungsgrad von ,4() gegenüber .4 = A'^ ( Abb. 5.7| >. Im 



Folgenden wird überwiegend diese Form zur graphischen Darstellung genutzt, da 
sich bestimmte Sachverhalte mit ihr besser veranschaulichen lassen. 

Für die Bewertung einer Handlungssequenz wird die Verlustfunktion f. ausgewer- 
tet. Hierzu werden die Knoten von B mit dem Verlust der zuletzt ausgeführten 
kooperativen Handlung annotiert: 

. / . 1 0 falls n = root , 

L{n) := <^ (530) 
[L{y.{pa{n)).a.(n). f Hn)- 1 ^n)~l) ^^onst 

Diese Werte können entlang des Weges von der Wurzel zu einem Knoten ii akku- 
muliert werden: 

,0 falls n ■= 7vot 

L{mot,n) — < , , , (5.31) 

Lyroot , pn{n)) 4- L[n) sonst 
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Abbildung 5.7: Alternative Baumstruktur B' der kooperativen Handlungssequen- 
zen. Die Farben der Knoten deuten an, welchem der beiden kooperativen Fahrzeu- 
ge die zuletzt ausgeführte Handlung zugeordnet ist. 

Die beste Handlungssequenz innerhalb von 13 entspricht dem Blatt n* mit mini- 
malem akkumulierten Verlust: 

n* = arg; min L{jt)ot,n) (5.32) 

Wegen der eindeutigen Zuordnung zwischen Blättern und Handlungssequenzen ist 
mit /j* auch die beste Handlungssequenz eindeutig bestimmt. Algorithmisch lässt 
sie sich durch rekursive Auswertung der Handlungen a.{pa{ti)) in den Elternkno- 
ten rekonstruieren. 

Der naive Ansatz zur Ermittlung von ii* wäre die vollständige Abarbeitung von 
ß. Dies erweist sich bereits für moderate Werte von ^4o, ^^ und T als nicht prak- 
tikabel. Beispielsweise erhält man für Aq = 10, AI = 3 und r = 3 eine Milliarde 
Blattknoten, sodass die Berechnung, selbst wenn 10 000 Knoten pro Sekunde ver- 
arbeitet werden, länger als einen Tag dauern würde. Um eine echtzeitfähige Bewe- 
gungsplanung zu ermöglichen, sind daher wesentliche Verbesserungen gegenüber 
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der naiven Vorgchensweise erforderlich. Hierzu bestehen prinzipiell zwei Ansatz- 
punkte: 

1. Die durchschnittlich benötigte Rcchcnzcit zur Abarbeitung eines Knotens 
kann reduziert werden. 

2. Die Anzahl der besuchten Knoten kann reduziert werden. 

Die Qualität der Lcisung soll durch diese Maßnahmen nicht beeinträchtigt werden. 
Bevor Knoten von der Suche ausgeschlossen werden dürfen, muss daher sicher- 
gestellt werden, dass diese Knoten nicht zur optimalen Lösung u* führen können. 
Hierzu muss geeignete Inf(^rmation über diese Knoten und insbesondere über ihre 
Vcriustfunktionswcrte /. bekannt sein. 

Im Ft)lgenden werden die beiden genannten Ansatzpunkte ausgearbeitet. Die ein- 
gesetzten Methoden sind insofern miteinander verwandt, als sie beide ausnutzen, 
dass das kooperative Problem auf bestimmte Art und Weise aus mehreren Einzel- 
fahrzcugproblemen zusammengesetzt ist. 



5.3.4 Wiederverwendung von Zwischenergebnissen 

Bei der naiven Traversierung des Baums werden für jeden Knoten die Zustän- 
de und Verlustfunktionswerte gemäB Gleichungen ( 5.-9a| . ( 5.3U| > berechnet. Zwar 



wird insgesamt gesehen für Jeden Knoten n eine individuelle Berechnung durch- 
geführt. Jedoch sind zahlreiche Rechenschritte nicht vom vollen kooperadven Zu- 
stand x{n) abhängig, sondern nur vom Zustand x, eines einzelnen Fahrzeugs 
Cj. Diese Rechenschritte können bei der Abarbeitung von ß mehrfach auftreten. 
Durch die Wiederverwendung der entsprechenden Zwischenergebnisse lässt sich 
die Rechenz.eit für diese redundanten Schritte einsparen. 

Abbildung 5.8| veranschaulicht das Auftreten redundanter Rechenschritte an ei- 
nem Beispiel. Die Handlung («i.oi «■2.0)'^ führe zu Knoten //, die Handlung 
(fl', Q, flo.o)^ zu Für Oi Qf^«i,() ist n'^ n. Das Fahrzeug ^2 hat jedoch in 
beiden Knoten denselben Zustand X2(n) = X2(n') = /2(x>(too^), 00,0. ^1 — ifo)» 
da sich die kooperativen Handlungen nur in der Handlung des ersten Fahrzeugs 
unterscheiden. Die beiden Handlungssequenzen ((«i^o^ «2.0)^ 1 («1,1 02.1 f) und 
(("i.O' <^2.o) ^\ («1.1' «2.1) M führen ebenfalls zu verschiedenen Knoten. Dennoch 
tritt bei ihrer Berechnung weitere Redundanz auf: Der Zustand des zweiten Fahr- 
zeugs ist in beiden Fällen gegeben durch /2{x>(?j.), oo 1 < ^2 — ^i)» da X2(n) = 
X2(n'). 
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m in' niim) - n-ii^ni') 

Abbildung 5.8: Beim Aufbau von ß' werden an den Knoten m und m' diesel- 
ben Zwischenergebnisse benötigt. Redundante Berechnungen können durch Nach- 
schlagen im Einzclfahrzcugbaum vermieden werden. 



Die folgenden Zwischenergebnisse hängen nur von den Handlungsentscheidungen 
eines einzelnen Fahrzeugs q ab: 

• Fahrzeugzustand x,(??) 

• Komponenten der Verlustfunktion: 

• Lf*'^^{n) (Vermeidung von Kollisionen mit Hindernissen) 

• U^^^{n) (Einschränkungen durch die Straßengeometrie) 

• Lf"^\n) (Fahrziele und Rechtsfahrgebot) 

• L^*'"'^"'(;j) (Bewertung der Handlungen hinsichtlich Fahrkomfort und 
Energieverbrauch) 

Diese Komponenten werden zu Z^^(/7) zusammengefasst: 

L^;-'{n) = Lf"\n) + U^'\n) -\- Lr'(n) + Lf "'"^'(n) (5.33) 

Die Beiträge Lf^f zum Term für die Kollisionsvermeidung zwischen kooperativen 
Fahrzeugen hängen nur von den Entscheidungen jeweils zweier Fahrzeuge c,;, cj 
ab liJudaschke94l . Daher können für M > 3 Redundanzen in der Berechnung der 
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j'(rj) auftreten, sodass sich durch geeignete Wiederverwendung von Zwischen- 
ergebnissen ebenfalls Rechenzeit einsparen lässi. Die Abhängigkeit von nur zwei 
Fahrzeugen bewirkt zylindrische Strukturen im Konfigurationsraum |LaValle98| . 

Die Unabhängigkeit von den Handlungen anderer Fahrzeuge gilt nur für Zustän- 
de vor einer möglichen Kollision mit einem anderen kooperativen Fahrzeug. Nach 
der Kollision zweier Fahrzeuge c, und c j sind deren Zustände miteinander verkop- 
pelt, da sich beispielsweise eine kollisionsvermeidende Handlung von Cj auch auf 
die Zustände und Verluslfunktionswerte von c, auswirkt. vSomit ist die Wiederver- 
wendung von Zwischenergebnissen in der beschriebenen Form für einen Teilbaum 
unterhalb einer möglichen Kollision zweier kooperativer Fahrzeuge nicht mehr 
möglich. Solche Teilbäume enthalten in aller Regel nur einen sehr geringen Anteil 
der Knoten von sodass sich der Zusatzaufwand durch die erneute Berechnung 
der Zustände und Verlustfunktionswerte in (Jrenzen hält. In dieser Arbeil wird je- 
doch auf die Modellierung des Fahrzeugverhaltens nach einer Kollision verzichtet, 
vor allem wegen der Schwierigkeit, in solchen Situationen Vorhersagen mit aus- 
reichender Sicherheit zu machen. Für das Ergebnis der Planung bedeutet dies, dass 
lediglich die Schwere der ersten Kollision zuverlässig minimiert werden kann (sie- 
he [Äbschniir633). In Fällen, in denen ein kollisionsvermeidender Plan existiert, 
wirkt sich diese Einschränkung nicht auf das Ergebnis aus. 

Als Datenstrukturen für das Speichern und Nachschlagen der Zwischenergebnisse 

bieten sich die Einzelfahrzeugbäume ß,, / = 1 M, an. Ihre Knoten n, werden 

mit X/(//;) und L^^ {n,) annotiert, sobald diese Werte beim Traversieren von ß 
das erste Mal berechnet werden. Wenn sie im weiteren Verlauf nochmals benötigt 
werden, können sie in nachgeschlagen werden, sodass der Aufwand für eine 
erneute Berechnung eingespart wird ( Abb. 5.8] i. Für dieses Vorgehen wird eine 




Zuordnung zwischen den Knoten n von ß und den Knoten von ß-, benötigt. 
Hierzu kann eine Abbildung 

ßi 

^ Iii 

konstruiert werden, die jedem Knoten n von ß den eindeutig bestimmten Knoten 
von ßj zuordnet, in dem Fahrzeug den gleichen Zustand und das gleiche 
Anfangsstück der Handlungssequenz hat wie in n. Es gilt also 

x,:(n,:(n)) - x,(n) a,(nj(7?)) «,(n) (5,35a) 

kimin)) - hin) paiiniin)) - ni{pa{n)) (5.35b) 



oder anders ausgedrückt 
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x(/0 = 



/ xi(ni(»)) \ 



\y.^f{n^fin))/ 



\oa/("a/(")), 



(5.36) 



Auf ähnliche Weise wird die Kollisionsiiirormalion L'''j'(/0 ^'^^'^ Zwei-Fahr- 
zeiig-Bäiimen Bi,), i < i <j < M, gespeichert. Das Nachschlagen erfolgt über die 



Abbildungen 



n 



1,3 




(5.37) 



die folgende Bedingungen erfüllen: 

Xi(n,j(rj)) = x,(n) 
Xj(7i.f.;(n)) = xj{n) 



ai{nij{n)) = a,(rj.) (5.38a) 
aj{nij{n)) = aj{n) (5.38b) 
i^i,j("ij('0) = nij{pa{n)) (5.38c) 



Die Implementierung der Abbildungen und tt j^j wird in Anhang A.3 .1 beschrie- 
ben. 

Hin Einzelfahrzeugbaum ßj hat 0{Aj) Knoten, ein Zwei-Fahrzeug-Baum ß,-.-/ 
hat 0{Äf^^) Knoten. Wegen des Spcichcraufwands und der Kosten für Initiali- 
sierung und Pflege der Datenstrukturen kann es unter Umständen sinnvoll sein, 
die Bäume nicht vollständig aufzuhauen, sondern nur bis zu einer Tiefe von S'sv 
bzw. S'coii. Insgesamt haben die Datenstrukiuren dann einen Speicheraufwand 
von 0{M -A^^' ) bzw. 0{M'- ■ Äq^'^""). Diese Abschätzungen stellen auch obe- 
re Schranken für den gesamten Rechenaufwand zur Bestimmung der x,(7?) und 
(/j.) bzw. der L^"j'(n) dar. Somit skaliert die Anzahl der Kollisionstests qua- 
dratisch mit der Anzahl der Fahrzeuge |LaValle98| I.ludaschke94| . Der gesamte 
asymptotische Rechenaufwand für die Suche nach iT in ß verringert sich durch 
die Wiederverwendung von Zwischenergebnissen dennoch nur um einen konstan- 
ten Faktor, da die Anzahl der besuchten Knoten unverändert bleibt und lediglich 
der durchschnittliche Zeitaufwand ic Knoten sinkt. 



5.3.5 Vorberechiiuiig von Schranken 

Eine weiterer Ansatz zur Beschleunigung des Baumsuchverfahrens besteht darin, 
die Anzahl der besuchten Knoten zu reduzieren. Dies ist möglich, wenn Teilbäume 
identifiziert werden können, die nicht zur optimalen Lösung /»* führen können. 
Um Letzteres beurteilen zu können, ist Informati(Mi über den Verlust innerhalb des 
Teilbaums hilfreich. In diesem Abschnitt wird beschrieben, wie eine Abschätzung 
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in Form von unteren Schranken bestimmt werden kann. Wie diese Schranken zur 



Beschleunißung der Suche eingesetzt werden können, wird anschließend in Ab- 



schnitt 5A6 erläutert. 



Um die unteren Schranken zu erhalten, wird wie im vorangegangenen Abschnitt 
auf die Einzelfahrzeugbäume zurückgegriffen. Die Einzelfahrzeugbäumc ß,, / = 

1 M, werden in einem Vorverarbeitungsschritt bis zu einer Tiefe von Psv 

vollständig aufgebaut. Wegen des Rechenaufwands für die Vorberechnung kann 
es unter Umständen vorteilhaft sein, die Vorberechnungstiefe geringer zu wäh- 
len als die Tiefe, bis zu der die Einzelfahrzeugbäume zur Wiederverwendung von 
Zwischenergebnissen genutzt werden: 0 < Psv < "^'sv £ T. 

In der Vorverarbeitungsphase werden die I-ahrzeugzustände x,(7j;) und Verlust- 
funktionswerte für alle Knoten Ui mit A'(/ij) < Psv berechnet. Aus dieser 
Information werden untere Schranken für den akkumulierten Verlust entlang einer 
Handlungssequenz konstruiert. 

Der akkumulierte Verlust L^^i u,. ) auf dem Weg von /?, nach //' wird in Verall- 
gcmcineiaing \on ( 5.3 1| wie folgt rckursiv definiert: 



Lf (n,,n;) := < 



0 falls «, = n; 

L^'^ini.paM)) + falls ^n', 



Diese Definition ist nur für Paare (n,. n') sinnvoll, bei denen Ui ein Vorfahre von 
n'j ist. Mit Hilfe der iterierten Eltcrnfunktion pa\^^ lässt sich diese Bedingung 
folgendermaßen formulieren: Uj — pa •*'\n^) für ein k > 0. 

Eine untere Schranke für den akkumulierten Verlust Lp («j, n^) erhält man, in- 
dem man das Minimum über den akkumulierten Verlust von u,- zu allen in Frage 



kommenden Nachfolgern bildet (Abb. 5.9 1. Nach diesem Prinzip können untere 



Schranken hi{ni) wie folgt rekursiv definiert werden: 



hiim) := < 



min {Lj (c/i,(/ij, a,)) + /<j(c/i,(7i,-, a,))} falls k{ni) < Psv 

0 falls k{ni) > Psv 

(5.40) 



Lemma 5.1 Gleichung ( )5.40{ ) liefert eine untere Schranke für den akku- 

mulierten Verlust Lp (/», , n'-) auf einem Weg von n, zu einem Blatt n'-: 

Für alle u, 6 Bj und alle € Bj mit A-(n') = T und po\^\}i'i) = n,: für ein k gilt: 

/i/(n,)</.r(n,.n;) (5.41) 
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n ( )hi{ni) = min [L^ {chi{ni,ai)) + //,(c7ji(n,, a,))} 




(i\LT{chi{ni,ai)) 

rhi{ni,ai) 
hi{chi{jii,ai)) 



Abbildung 5.9: Illustration der Vorgehensweise zur Bereclinung unterer Schran- 
ken in Bi. 



Beweis: Sei zunächst f sv = T und das Blatt /»' unter den Bedingungen des Lem- 
mas so gewählt, dass Ly'^'(n,. //' ) minimal ist: L^^(n/. ny) < L-^ (/i,, n'-') für alle 
zulässigen Blätter /<•'. Dann korrespondiert // zu der Handlungssequenz, die in 
( j5.4ü| konstruiert wird, somit ist lii{n}) = L,(rj,-, /?'). Wegen der Wahl von //' ist 
hi{ni) = Lf^(/j,:, n,) < n'- ) für alle anderen in Frage kommenden Blätter 

nf. 

Im Fall Psv < P sind die Werte von /?j(n,) kleiner oder gleich den Werten aus dem 
ersten Fall. Somit folgt ///(//,) < Lp (n,-, // ■') für alle zulässigen Blätter n ■'. □ 



Das Konzept zur Definition von unleren Schranken lässt sich auch auf die Kolli- 
sionsbewertung L*^''" übertragen. Hierzu werden die Zwei-Fahrzeug-Bäume Bij 
{l<i<j< M) mit den bis zu einer Tiefe von Fa.n vorberechnet (0 < 

Pcoii < 'S'coii < T). Da für die Kollisionstests die Fahrzeugpositionen x,(/?,(n/j)), 
Kj{nj{ni j)) aus den Einzelfahrzeugbäumen benötigt werden, ist die Forderung 
Pcoii < Psv sinnvoll. Nach dem gleichen Prinzip wie bei den /j,(77,) lassen sich 
nun rekursiv untere Schranken hij{nij) für die akkumulierte Kollisionsbewer- 
tung berechnen: 

I 0 falls k{nij) > Pcoii 

^idi^^j) - { niin min {hij{nij,ai,aj)} falls /i:(nij) < Pcoii 

I ft, *- At aj^A) 

+ hi^y{chij{ni^j. [a^^aj)^)) 

Die Fahrzeugzustände x,(ni.j), Xj(n, j) können den vorbcrcchnctcn Cinzclfahr- 
zeugbäumen ß, entnommen werden. Dass es sich um untere Schranken für den 
akkumulierten Kollisionsverlust L'^*^^^{nij^n'j j) bis zu einem Blatt n'^ j von ßi j 
handelt, lässt sich ähnlich zeigen wie bei den /),(n,), weshalb hier auf einen Be- 
weis der folgenden Au.ssage verzichtet wird. 



(5.42a) 
(5.42b) 
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Lemma 5.2 Der Ausdruck hij{nij) nach ( )5.42| ist eine untere Schranke für den 



Verlust L^ j', der auf einem Weg von Jiij bis zu einem Blatt 7i[ j von Bij akku- 
muliert wird: 

Für alle /i,.; € 5,.; und alle u'- j 6 -ß,./ mit = T und p«/ jY^'ij) — ^^^j J für 

ein k gilt: 

/^ij(n^j)<L^3'(n,,^,<^) (5.43) 

□ 

Eine untere Schranke für den akkumulierten Verlust L{n, n') bis zu einem Blatt ?i' 
des Baums ß der kooperativen I landlungssequenzen erhält man nun als 



0 falls k{n) > Fsv 

EiLi^^iMn)) falls n„„ < kin) 

Efii {hiiniin)) + Ef ,+1 /'i-j^ij!"))) falls kin) < P,,„ 



(5.44) 

Es werden also die unteren Schranken aller Fahrzeuge und Fahrzeugpaare auf- 
summieri, sofern die entsprechende Vorberechnung durchgeführt wurde. Da für je- 
des Fahrzeug eine Handlungssequenz bis zu einem Blaltknoten ausgeführt werden 
muss, wird für dieses Fahrzeug mindestens der minimal mögliche Verlust /*,:(/»,) 
eintreten. Entsprechendes gilt für die Kollisionsbewertung der Fahrzeugpaare. For- 
mal folgt die Eigenschaft der unteren Schranke aus der additiven Zusammenset- 
zung der Verluslfunklion aus den einzelnen Termen: 



Satz 5.3 Gleichung ( |5.44 ) liefert eine untere Schranke h{n) für den akkumulier- 



ten Verlust L(n, //) bis zu einem Blaltknoten von B: 
Für alle n 6 B und alle n' 6 B mit k{n') = T und pa^'^^n') = n für ein k gilt: 

hin) < Lin. n') (5.45) 

Beweis: Sei zunächst Pfou — Psv — T. 

M / M \ 

hin) = ^ hiin,in)) + ^ h,j{nijin}) (5.46) 

M / M \ 

< E ^r(«i(")^ n>in')) + J2 ^:J{ni.Jin)^nLJin')) (5.47) 
/ 1 \ j '+1 / 

= Lin.n') (5.48) 
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Die Ungleichung folgt aus den vorangegangenen Lemmata 



5. 



und 



die letzte 



■3<)| i, seiner Terme 



Gleichheit aus der Definition des Verluslfunklionals L p.\A 
L^°" ([5J7), I'^"^^' (g32d). L^"'"^ ( |533c) , L^°"""'^' i l53] t. L^"" ( |5:24ct sowie des 
EinzcItahrzcugvcrlustsT^^ (533). 



Für Pcoii < Av < T ist der Wert /«(n) nach \5AA\ kleiner oder gleich dem Wert 
aus dem ersten Fall. Somit ist auch hier h{n) < L{n, n'). □ 



Die unteren Schranken h{n) gemäf3 t |5.44^ werden im Gegensatz zu den 
und hij{nij) nicht in der Vorverarbeiiungsphase berechnet, sondern erst während 
der Traversierung von B. Der Grund dafür ist, dass diese Werte für jeden Knoten n 
von ß verschieden sind und daher nicht in den Datcnsti"ukturen ßi, ßi j gespeichert 
werden können. Bei der Berechnung von h{n) werden die benötigten hi{ni) und 
hij{fH,i) in den vorberechneten Einzelfahrzeughäumen /?, und Zwei-Fahrzeug- 
Bäumen ßij nachgeschlagen. 

Die unteren Schranken stellen eine wichtige Voraussetzung für eine gezieltere und 
damit schnellere Suche in ß dar. Andererseits ist die Bestimmung der unteren 
Schranken mit einem zusätzlichen Rechenaufwand verbunden, der gegen den Ge- 
winn bei der Suche abgewogen werden muss. Da die Berechnung pro Knoten kon- 
stante Zeit erfordert, ergibt sich der Rechen- und Spcichcraufwand für die unteren 
Schranken und hi j{nij) nach den Erychiiisscii des vorangegangenen Ab- 



^0 



). In Anhang A.3.2 



ist das Verfahren zur 



Schnitts zu 0{M A 
Vorberechnung unterer Schranken im Pseudocode dargestellt. 

Nach dem gleichen Prinzip können auch obere Schranken für die Verlusifunkti- 
on L berechnet werden, wenn die Minimumhildung in ( 5.40} und (5.42 1 durch eine 
Maximumbildung ersetzt wird. Um korrekte obere Schranken zu erhalten, müssen 
allerdings die vollständigen Wege zu den Blallknoten betrachtet werden. Daraus 
ergibt sich zwingend Psw — Pcoii ~ T, sodass ein erheblicher Vorberechnungsauf- 
wand unvermeidlich ist. Versuche haben gezeigt, dass mit vorberechneten oberen 
Schranken nur in sehr wenigen Fällen eine geringfügige Cffizienzsteigerung der 
Suche erreicht werden kann. Dies liegt vor allem daran, dass in vielen Knoten eine 
Handlunc existiert, die zu einem hohen Verlust durch eine Kollision oder durch das 
Verlassen der Straße führt. Somit liefert die Maximumbildiing bei der Berechnung 
oberer Schranken häufig keine gute Näherung für den optimalen Verlust. 



5.3.6 Suchstrategieii 

Der Baum ß der kooperativen Handlungssequenzen wird nicht vollständig aufge- 
baut. Bei der Suche nach der besten Lösung werden nur die benötigten Teilberei- 
che inkrementcll konstruiert. Welche Knoten in welcher Reihenfolge abgearbci- 
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L*=l 



L{mot, n) 




> hin) 



Abbildung 5.10: Kriterium zum Ausschluss eines Teilbaums von der Suche. 

tet werden, wird erst während der Suche entschieden. Dieser Abschnitt beschreibt 
7-wci verschiedene Suchstrategien für den Baumsuchalgorithmus. Beide Strategien 
profitieren erheblich von den vorberechneten unteren Schranken, 

5.3.6.1 Branch and Bound 

Eine Möglichkeit zur Suche im Baum ß ist die Branch-and-Bound-Strategie 
ILawler66l IMehlhorn^Sl . Die Knoten werden in der Reihenfolge einer Tiefen- 
suche abgearbeitet. Wenn ein Blatt n erreicht wird, ist die vollständige Bewer- 
tung der korrespondierenden Handlungssequenz in Form des Verlustfunktions- 
werls L{root, n) bekannt. Die beste bisher gefundene Handlungssequenz n* und 
ihre Bewertung L* := L{root, ii*) werden gespeichert. Letzlere stellt eine obere 
Schranke für den Verlustfunktionswert der besten Lösung dar. 

An einem inneren Knoten ii kann sein akkumulierter Verlustfunktionswert 
L{root. n) mit L* verglichen werden. Falls L{root, n) > L* gilt, kann die opti- 
male Handlungssequenz nicht durch // verlaufen. Denn für alle Nachfahren n' 
von n gilt gemäß den Eigenschaften der Verluslfunklion L{n, n')>0, somit ist 
L{root, n') = L{ tvot, n) I L(n, n') > L{njot, ii) > L*. Daher muss in diesem Fall 
der Teilbaum mit der Wurzel t) nicht weiter betrachtet werden, und die Tiefensuche 
kann beim Elternknoten p(i{n) fortgesetzt werden. 

Mit Hilfe der unleren Schranke }i{u) kann ein schärferes Kriterium für das Ab- 



schneiden von Teilbäumen formulieri werden (Abb. 5.10 : Wegen L{rooi, ii') — 
L{root.n) + L{n,n')> L{tvot., n) + h{ii) für alle Blätter /;' mit paS^^n') = n 
kann der Teilbaum mit der Wurzel n von der Suche ausgeschlossen werden, falls 



L{}'oot, n) + h{n) > L* 



(5.49) 



5.3 Baumsuche mit Vorberechnungen 
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Die vorberechneten unteren Schranken ermöglichen somit den Ausschluss von 
Teilbäumen, die nicht die optimale Lösung enthalten. Die Anzahl der besuchten 
Knoten lässt sich dadurch stark reduzieren (siehe [RITpitcl 6.3[ t. 

Eine weitere Verwendungsmöglichkeit für die unteren Schranken besteht bei der 
Auswahl des Kindknotens, der als nächster besucht wird. Für jeden Kindknoten 
c/i(ri,a) von n wird die untere Schranke a)) berechnet. Die Kindknoten 

werden nun in aufsteigender Reihenfolge der Werte L(c/j(n,a)) -f- /»(f/i(/},a)) ab- 
gearbeitet. Mit dieser Heuristik werden gute Lösungen im Durchschnitt früher ge- 
funden als bei zufälliger Auswahl des nächsten Kindknotens. Dadurch erhält man 
schneller eine niedrige obere Schranke L*, die ein effektiveres Abschneiden von 
Teilbäumen ermöglicht. 



Der Branch-and-Bound-AIgorithmus ist in Anhang A.3.3 im Pscudocode dargc- 
.stellt. Er hat einen sehr geringen Speicheraufwand, da lediglich der aktuell un- 
tersuchte Weg L{root, n) sowie die beste bisher gefundene Lösung n* und ihre 
Bewertung L* im Speicher gehalten werden. 



5.3.6.2 A* 

Bei der A*-Suchc Ii Iart68l wird die Abarbeitungsreihenfolge der Knoten mit Hilfe 
einer Bewertungsfunktion g{n) bestimmt. Die bekannten Knoten werden in einer 
Prioritätswarteschlange gespeichert, die nach dieser Bewertung sortiert ist. Die- 
se Prioritätswarteschlange wird häufig als open-Lhte bezeichnet. Initialisiert wird 
die Wartcschlangc mit dem Startknoten. In dieser Anwendung ist dies die Wurzel 
von ß. Unter den bekannten Knoten in der Warteschlange wird derjenige mit mi- 
nimalem g{n) ausgewählt. Seine Kindknoten ch{n,a) werden generiert, mittels g 
bewertet und in die Prioritätswarteschlange eingefügt. 

Die Bewertungsfunktion g{n) wird mit Hilfe der unteren Schranke h{n) wie folgt 
definiert: 

g{n) ■- L{wot, n) + /*(«) (5.50) 

Bei der A*-Suche muss die Funktion h{n), die in diesem Kontext häufig als Heu- 
ristikfunktion bezeichnet wird, eine untere Schranke für den akkumulierten Ver- 
lust L{n, n') zu einem Zielpunkt n' liefern, damit die Optimalität des Ergebnisses 



garantiert ist IRussell03l . Mit h{n) aus ( |5.44) ist diese Forderung nach Satz 5.3 
erfüllt. 

Bei der Anwendung zur kooperativen Bewegungsplanung stellt jedes Blatt von 
ß einen möglichen Zielpunkt dar. Die Suche terminiert, wenn das erste Mal ein 
Blatt zur weiteren Verarbeitung ausgewählt wird. Dieses Blatt n* entspricht der 
optimalen Handlungssequenz. 
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Da die Suchstratcgic auf einen Baum angewandt wird, ergeben sich einige Verein- 
fachungen gegenüber dem allgemeinen A*-Algürilhmus. Jeder Knoten ii kann von 
der Wurzel aus auf genau einem Weg erreicht werden. Daher kann es nicht passie- 
ren, dass ein anderer Weg mit einem geringeren Vcrlustfunktionswcrt L{root, n) 
gefunden wird. Bei der Gcncricrung des Knotens n ist also sofort der optimale 
akkumulierte Verlust L{root, n) bekannt. Nachträgliche Änderungen an Knoten, 
die bereits in die Priori tälswarieschlange eingefügt wurden, sind daher nicht erfor- 
derlich. Außerdem kann auf die so senannle closed-Lisia verzichtet werden, in der 
normalerweise die abgearbeiteten Knoten gespeichert werden. Denn ein bereits 
abgearbeiteter Knoten kann nicht nochmals angetroffen werden, da Bäume keine 
Zyklen enthalten. 

In der Prioritätsvvarteschlange werden von einem Knoten n sein Identifikator, sein 
akkumulierter Verluslfunktionswert L{root, n) und seine Bewertung tj{n) gespei- 
chert. Im lüill A:(/i)>5sv muss zusätzlich der Zustandsveklor x(7/) gespeichert 
werden, der ansonsten in den Bj nachgeschlagen werden kann. Die Handlungs- 
sequenz zu der Lösung n* kann rekursiv aus dem Identifikator des Knotens re- 
konstruiert werden. Die Einzelheiten dieses Verfahrens und der Pseudocode der 
A'''-Suche werden in Anhang A.3.4 dargestellt. 

Im Unterschied zur Branch-and-Bound-Suche, die schnell zu einem Blatt absteigt, 
um eine obere Schranke L" zu erhalten, zeigt A* eher ein Breitensuchverhalten. 
Dadurch kann häufig das Besuchen suboptimaler Knoten in den tieferen Schichten 
vermieden werden. Erkauft wird dieser Vorteil durch die zusätzlichen Kosten für 
die Prioritätswarteschlangc. Der Rechenaufwand für die bcncitigten Operationen 
iNSliRT und RüMüvtMimmum ist logarithmisch in der Größe der Warteschlan- 
ge, sodass die Abarbeitung eines Knotens nicht mehr in konstanter Zeit möglich 
ist. Im schlimmsten Fall kann die Warteschlange alle .4^^ " ^ Blätter enthalten. Da- 
her ist auch ihr Spcicheraufvvand von erheblicher Bedeutung. 



5.3.7 Analyse der Vollständigkeit 

Ein wichtiges Kriterium bei der Analyse von Bewegungsplanungsalgorithmen ist 
der Begriff der Vollständigkeit bezüglich eines Auflösungsparameters. Viele Al- 
gorithmen verfügen über AuHösungsparameter, die typischerweise einen Abtast- 
schritt beschreiben |Chosct05l Anhang G.31. 

Definition 5.4 (Vollständigkeit bezüglich eines Auflösungsparameters) 

Ein Bewegungsplanungsalgorithmus heißt vollständig bezüglich eines Auflö- 
sungsparameters bzw. Auflösungsparametervektors, falls er für eine geeignete 
Wahl der Parameter Jedes Bewegungsplanungsproblem lösen kann, für das eine 
kollisionsfreic Lösung existiert iLatomhc^ 1 1 Kapitel 6). 



5.3 Baumsuche mit Vorberechmmgen 
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Durch eine schrittweise Verfeinerung der Abtastung kann jede existierende Lö- 
sung in endlicher Zeit gefunden werden ILaVallc06i Kapitel 5J. Wenn mit dem 
gewählten Auflösungsparameter keine Lösung gefunden werden kann, wird die 
Abtastung in der nächsten Itcration verfeinert. Falls keine Lösung existiert, termi- 
niert der Algorithmus nicht. 

Beim vorgeschlagenen Baumsuchalgorithmus zur kooperativen Bewegungspla- 
nung werden an mehreren Stellen Diskretisierungen vorgenommen. Über eine ge- 
eignete Parametrierung dieser Diskretisierungsschritte lässt sich die Vollständig- 
keit bezüglich der Auflösung zeigen. Zunächst wird von der Zcitdiskrctisicrung 
eine Einschränkung des Lösungsraums verursacht. Zur Vereinfachung der Analy- 
se werden in diesem Abschnitt äquidistante Entscheidungszeitpunkte 1^ — A- • 
angenommen. Das Zeitintervall A/ hängt dann wie folgt mit dem Planungshori- 
zont /h und der Anzahl der Entscheidungszeitpunkle T zusammen: t\^^T • Af. 



Die diskreten Handlungen wurden in Abschnitt 5.3.2.2| aus einem zweidimen- 



sionalen Kontinuum ausgewählt. Für die Analyse der Vollständigkeit werden die 
Handlungen nun über den Beschleunigungsvektor in Polarkoordinatendarstellung 
parametriert: 

* =acc,-,res- .n (5.51) 



( 



I ».res I • n 

Den Lcnkwinkel n, erhält man dann aus l |5.9^ . Zur Sichcrstcllung der Vollständig- 
keit bezüglich der Auflösung genügt es, wenn die Diskretisierung A^, der Rich- 
tung Oj verfeinert wird. Der Betrag «cc,.rcs wird unter Einhaltung von ( 15. 12^ maxi- 
mal gewählt, d. h. der Beschleunigungsvektor liegt stets auf der Begrenzungslinie 
des Kamm'schen Kreises iSchmidtOöl . Alle Bcschlcunigungsvektoren innerhalb 
des Kreises lassen sich für At 0 durch mehrere aufeinanderfolgende Beschleu- 
nigungen mit maximalem Betrag beliebig genau approximieren. 

Schließlich werden bei der Modellierung der Geometrie von Fahrzeugen, Hinder- 
nissen und Straßen Approximationen vorgenommen, die ebenfalls die Vollstän- 
digkeit einschränken können. Hierfür wird der Parameter Sq eingeführt, der die 
maximale Abweichung der Modelle von der tatsächlichen Geometrie quantifiziert. 
Diese Abweichung lässt sich durch die Verfeinerung der Mcidclle beliebig redu- 
zieren. 

Satz 5.5 (Vollständigkeit des Baunisuchplaners) Der Baiimsuchalgorithmus ist 
vollständig bezüglich der Auflösungsparameter At, A6i und sq. 

Beweis: Sei 'y{f) eine zulässige Lösungstrajektorie eines Bewegungsplanungs- 
problems. Zu zeigen ist, dass der Algorithmus für geeignete Auflösungsparameter 
diese Trajektorie finden kann. 
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Zu den Einzelfahrzeugtrajektorien ii{t) lassen sich die Beschleunigungsvektoren 
berechnen, die ( 5. 1 2| erfüllen müssen. Wie oben erläutert, kann die Abfolge dieser 
Bcschlcunigungsvektorcn für AOj — »■ 0 und 0 beliebig genau approximiert 

werden. Da der Baumsuchalgorithmus beliebige Sequenzen von Handlungen aus 
Ai zulässt, kann auch beliebig genau approximiert werden. 

Da alle Kombinationen von Einzelfahrzeughandlungcn im Baum ß enthalten sind, 
kann der Algorithmus auch die entsprechende kooperative Handlungssequenz und 
die Trajektorie 7(/) finden. Zudem ist für ü sichergestellt, dass der Algo- 

rithmus die Trajektorie als kollisionsfrei erkennt. □ 



Die praktische Anwendung dieses Ergebnisses ist kaum möglich: Die für eine an- 
nähernde Vollständigkeit notwendige Verfeinerung der Zeit- und Handlungsdis- 
krctisicrung lässt sich bei weitem nicht erreichen, da der Rechenaufwand bereits 
deutlich früher so stark ansteigt, dass eine echtzeilfähige Implementierung uner- 
reichbar scheint. Die Vollständigkeil des Baumsuchverfahrens leidet insbesondere 
unter einer groben Zeildiskretisierung, wie in Kapitel 6.4 gezeigt wird. 

Der Werl des obigen Satzes liegt vielmehr in der Erkenntnis, dass die Vollständig- 
keit des Baumsuchplaners ausschließlich durch die genannten Diskretisierungs- 
schritte eingeschränkt wird. Der Algorithmus selbst ist prinzipiell vollständig be- 
züglich der Auflösungsparameter. Die Approximationen kommen in der Model- 
lierung aus Abschnitt 5.3.2| explizit zum Ausdruck. Damit unterscheidet sich das 



Baumsuchverfahren von zahlreichen anderen Bewegungsplanern, die aufgrund 
von Entkopplungsannahmen, einer lokalen Sichlweise oder der Beschränkung auf 
bestimmte Klassen von Modellen keine Vollständigkeit erreichen können. 



5.4 Gemischt-ganzzahlige lineare Programmierung 



Das Problem der kooperativen Kollisionsvermeidung im Straßenverkehr wird 
in diesem Abschnitt als gemischt-ganzzahliges lineares Programm modelliert. 



Als Grundlage dienen die in Abschnitt 2.3.5.3 erwähnten Arbeiten zur koope- 
rativen Bewegungsplanung für Flugzeuge mittels gemischt-ganzzahliger linea- 
rer Programmierung (MILP). Die wesentlichen Erweiterungen für die Anwen- 
dung im Straßenverkehr sind eine genauere Berücksichtigung der Fahrzeuggeome- 
trie ( |Abschnitt 5.4. 2f , die Modellierung des Straßennetzes ( Abschnitt 5.4.3| und 
die Elimination von binären Variablen durch Erreichbarkeitsbetrachtungen ( Ab- 
schnitt 5.4.4) . 
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5.4.1 FahrzeugmodcU 

Die geplante Bewegung eines Fahrzeugs c-, wird durch eine zeitdiskrete Folge 

von Positionen p,:,fc = {xi^u^ Vi^k)^ , k = 0 T, beschrieben. Es wird eine äqui- 

distante Zeitdiskretisierung mit Abtastintervall At verwendet, sodass die Fahr- 
zeugposition pi dem Zeitpunkt k ■ AI zugeordnet ist. Die Geschwindigkeiten zu 
den Abtastzeitpunklen werden vekloriell modelliert, vel,./, — {velj^t^^x.^ i^'f^ii,k\y)^ 
wobei die beiden Komponenten des Vektors den Geschwindigkeiten entlang der 
Achsen des Koordinatensystems entsprechen. Die Orientierung des Fahrzeugs in 
der Ebene ergibt sich implizit aus der Abfolge der Positions- und Geschwindig- 
keitsvektoren. 

Die Handlungen eines Fahrzeugs werden durch seine vektoriellen Beschleuni- 
gungen zu den Abtaslzeilpunkten beschrieben: accj. fc = (accjjt.xi "f-'Q.fc,))^- l'i^ 
Gegensatz zum Baumsuchveriahren aus dem vorangegangenen Abschnitt muss 
hier keine Diskretisierung der Handlungsoptionen vorgenommen werden. Positio- 
nen Pi.A , Geschwindigkeiten vel, /. und Beschleunigungen accj j^, i — 1, , . . , M, 
k= l T, stellen die kontinuierlichen Variablen des gemischt-ganzzahligen li- 
nearen Programms dar. Die beiden Vektoren p,.n und vel/^o bilden den Anfangs- 
zustand des Fahrzeugs ab und sind daher Konstanten. 

Die Bewegungsgleichungen des Fahrzeugs werden in Form von Nebenbedingun- 
gen an diese Variablen spezifiziert. Das Zustandsraummodcll \5.6\ kann allerdings 
nicht verwendet werden, da es Nichtlincari täten enthält. Stattdessen wird die Fahr- 
zeugdynamik durch die folgenden linearen Gleichungen beschrieben: 

vel,.^ = vel/.A:_i 4 A/ -acc.A (5.52a) 
P»,Ar = Pi,k-i + ■ vel,-.^._i + i • [At f ■ acc,:,jt (5.52b) 
k=l,...,T, i = l,...,A/ (5.52c) 

Die Rotation des Fahrzeugs kann nicht explizit berücksichtigt werden, da hierfür 
nichtlineare trigonometrische Funktionen benötigt werden. 

Für die Geschwindiskciten und Bcschleunieuniien werden Schranken definiert. 



die aus den dynamischen Fähigkeiten der Fahrzeuge abgeleitet werden (vgl. Ab- 



schnitt 5.3.2. 1[ . Die Beschränkungen durch die nichtholonome Kinematik, die 



vor allem bei niedrigen Geschwindigkeiten relevant sind, werden nicht explizit 
modelliert, da sie sich nicht linear formulieren lassen. Die vorgestellte MILP- 
Bcwegungsplanung ist daher bei niedrigen Geschwindigkeiten nur eingeschränkt 
anwendbar. 



Die Dynamik wird durch Intervalle für die Beschicunigungswerte sowie durch ei- 
ne lineare Approximation des Kamm'schcn Kreises modelliert. Bezogen auf die 
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Orientierung 0,-^o des Fahrzeugs im Anfangszustand können die Intervalle der Be- 
schleunigungsfähigkeit wie folgt formuliert werden: 



cos((^j,o) • acci,jt,x + sin(<^i,o) • acc,,fc,y < acci.max (5.53a) 

cos(0i,o) • o.cci^k,x + sin(0i,ü) • acc^i,k,y > acci „,m (5.53b) 

- sin(<i!>,.o) • acci^k,x + cos((^i,o) • acci^k,y < accija,,n,ax (5.53c) 

- sin(<5i>i,o) • aCCi,k,x + COs(0i,o) • aca^k^y > -OCCi,iat,max (5.53d) 

Ä:=1,...,T, i=l,...,M (5.53e) 



Die Nebenbedingungen werden in Bezug auf die Anfangsorientierung (^».o formu- 
liert, weil die spätere Orientierung während der geplanten Bewegung im linearen 
Modell nicht berechnet werden kann. Nach einer geplanten Lenkbewegung wer- 
den die fahrdynamischen Begrenzungen daher nur noch näherungsweise abgebil- 
det. Dadurch ist die Anwendbarkeit des MILP- Verfahrens bei Kurvenfahrlen mit 
größeren Orientierungsänderungen eingeschränkt. 

Die nichtlineare Ungleichung der Kamm'schen Kreisscheibe lässt sich gut 
durch die Ungleichungen eines regelmäßigen A'-Ecks annähern Ikichards02 
Niedringhaus95) . Bei AKamm Eckpunkten erhält man folgende Nebenbedingungen 

<\Ahb. 

/ 2-7zl\ . / 2-7r./\ 
cos 0,,o + • acci.fc,x + sin 0i,o + -77 1 * acci^k,y 

\ -'^Kamill/ \ ■'VKamm/ 

\ AfKamm/ 

/= L...,AVamm, k = 1, , . . ,T, i= 1,...,A/ 



(5.54a) 
(5.54b) 



Der Faktor cosf-rr^ — )< 1 bewirkt eine konservative Approximation durch das 

einbeschriebene A^Kamm-C^"!^ |Bronstc]"n()() Abschnitt 3.1.5.2). Im Allgemeinen 
sind einige Ungleichungen der Systeme ( 5753f und ( |5.54 1 redundant. 



In ähnlicher Weise können Schranken für die Geschwindigkeiten velj^jt definiert 
werden, sodass ihr Betrag näherungsweisc im Intcr\'all [0, velmax] liegt. 

Als zu minimierende Zielfunktion kann der Betrau der Bcschleuniiiuniien vcrwcn- 
det werden |Richards()21IFierro'Ö5ll . Diese Zielfunktion ist analog zum Term L*^""'™' 



des Verlustfunktionals aus Abschnitt 5.3.2.3 Die übrieen Anforderungen werden 



in der MILP-Formulierung durch harte Nebenbedingungen erzwungen und müs- 
sen daher nicht in die Zielfunktion aufgenommen werden. 
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Zur Modellierung der Beträge der Beschleunigungen werden zunächst Hilfsva- 
riablc nccabsi j,^, orm/w, ^. v eingeführt. Mit Hilfe der folgenden Ungleichungen 
lässt sich die nichdineare Betragsfunktion abbilden: 

accabsi k.x > «"^Avx (5.55a) 

accabsi^k.x > -acci^k.x (5.55b) 

accabsi^k.y > aft*t,/r,y (5.55c) 

accabsi^k^y > —occi^k,y (5.55d) 

jt=l,...,T, i = l,...,A/ (5.55e) 

Das Optimierungskriterium kann nun wie folgt formuliert werden: 

T M 

min ^ ^ {accabsi^f^x + ii(^cabsi^k,y) (5.56) 



5.4.2 Kollisionsverineidung 

Die Kollisionsvermcidung zwischen den kooperierenden Fahrzeugen Cj und cj 
lässt sich erreichen, indem ein Mindestabstand zwischen den Fahrzeugpositionen 
Pi,k und pj^k mit gleichem Zeitindex A- erzwungen wird. In Arbeiten zur Bewe- 
gungsplanung für Flugzeuge wird meistens ein quadratischer Sicherheitsbereich 
vorgegeben, in dem sich kein anderes Flugzeug befinden darf |jRichard.s02l . Um 
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die Kollisionsfreiheit sicherzustellen, kann die Position des zweiten Flugzeugs auf 
einer beliebigen Seite außerhalb des Quadrats liegen. Daher erhält man für ein 
achsenparalleles Quadrat mit Seitenlänge cU j folgende Bedingungen: 

Xj,k > Xi^k + di^j (5.57a) 

V XjM < Xi,k - dij (5.57b) 

V yj^ > yi.k 4- dij (5.57c) 

V yu < yi,k - dij (5.57d) 

Die Lösung eines MILPs muss alle Nebenbedingungen gleichzeitig erfüllen. Um 
die Kollisionsvermeidung im MILP formulieren zu können, müssen die logi- 
schen Oder- Verknüpfungen aus ( |5.57^ in Und-Verknüpfungen umgewandelt wer- 
den. Da/u wird ein Standardverfahren aus der MILP-Modcllicrung eingesetzt 
ISierksnia96l . Es werden binäre Variable bfjf^ ^ eingeführt, um zu erreichen, dass 
nur eine der Ungleichungen erfüllt sein muss: 

-Xi,k + xj,t, I K ■ > dij (5.58a) 

-yi,k + yj,k + K • b';%_s > dij (5.58c) 
yi,k - yj,k-^K- b^l^,, > dij (5.58d) 

oll ^ 

J,kJ ^ 



< 3 (5.58e) 



feijlMe{0,l}, /=!,..., 4 (5.58f) 
k=l,...,T, i = l,...,A/, j = i+l,...,J\/ (5.58g) 

Darin ist K 3> 0 eine Konstante, die größer ist als alle anderen auftretenden Wer- 
te. Somit ist im Fall b^'^ff^ i = 1 die entsprechende Ungleichung erfüllt. Wegen 
( 5.58c) muss ft^'^j'jt ; = 0 für mindestens ein / gelten, sodass mindestens eine der 



oder-verknüpften Ungleichungen ( 15.5 7 1 greift und die Kollisionsvermeidung si- 
cherstellt. 

Nach dem gleichen Prinzip kann auch die Vermeidung von Kollisionen mit Hinder- 
nissen modelliert werden. Anstatt der Positionsvariablen pjj; sind die konstanten 
iiindernispositionen p'^^^^ — {x^^^^l^ , yj^^^)^ einzusetzen. Die Sicherheitsabstände 
können in Abhängigkeit der llindernisgeometrie gewählt werden. Die ent- 
sprechenden binären Variablen werden mit f>'I^J\, ^ bezeichnet. 

Für die vorliegende Anwendung erreicht ein quadratisches Geometriemodell der 
Fahrzeuge nicht die erforderliche Genauigkeit: Um die Kollisionsfreiheit sicherzu- 
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stellen, müsste eine konservative Überapproximation der Fahrz.euggeometrie ge- 
wählt werden, die das Passieren ZAveier Fahrzeuge auf benachbarten Fahrspuren 
unmöglich macht. Daher werden im Folgenden zwei Möglichkeiten untersucht, 
wie im Rahmen der linearen Modellierung eine detailliertere Geometriebeschrei- 
bung konstruiert werden kann. 



5.4.2.1 Berücksichtigung der Vorgänger- und Nachfolgerpositionen 

Ein denkbarer Ansatz zur genaueren Modellierung der Fahrzeuggeometrie ist eine 
Überdeckung durch mehrerer Quadrate. Die relative Lage dieser Quadrate bezogen 
auf den Fahrzeugreferenzpunkt pj,^ hängt jedoch von der Orientierung des Fahr- 
zeugs ab, die im linearen Modell nicht verfügbar ist. Einen möglichen Ausweg 
bieten die kinematischen und dynamischen Nebenbedingungen der Fahrzeugbe- 
wegung, die einen Zusammenhang zwischen Geometrie und Positionen des Fahr- 
zeugs herstellen: Bei geeigneter Zeitdiskretisierung befindet sich die Fahrzeug- 
front zum Zeitschritt k ungefähr dort, wo zum Zeitschritt A- + 1 der Referenzpunkt 
Pi,Ä:+i liegt. Analog dazu stimmt die Position des Fahrzeughecks zum Zeitschritt 
k ungefähr mit der Lage des Referenzpunkts pj.A-i im vorangehenden Zeitschritt 
überein. Dieser Zusammenhang kann genutzt werden, um die Fahrzeuggeomelrie 
beispielsweise durch drei überiappende achsenparallele Quadrate zu approximie- 
ren ( Abb. 5.1 2(a)^ . Der Sicherheitsabstand kann nun geringer gewählt werden. 



sodass zwei Fahrzeuge auf benachbarten Fahrspuren aneinander vorbeifahren kön- 
nen. Für das gcmischt-ganzzahlige lineare Programm ergeben sich zusätzlich zum 
System ( j5.58| die folgenden Nebenbedingungen: 



-0:^.^+1 + or,,^ + A- • h^^^^ > di j (5.59a) 

Xi,,^,-xj,,-^K-bff;l,^,>dij (5.59b) 

+ i + yj,k + ^ • > dij (5.59c) 

yi,k+i -yj,k^K- > dij (5.59d) 

8 

bij.u e {0,1}, /-5,...,8 (5.59f) 

A: = 0, ...,r-L M, J - i + l M (5.59g) 
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P.i.k- 



Pi.k 





Pik 



(b) 



Abbildung 5.12: Alternative Modellierungen der Kollisionsvermeidung. (a) Be 



rücksichtigung von Vorgänger- und Nachfolgcrpositioncn. (b) rechteckige Fahr 



zeuggeometne. 



-Xi^k-i + Xj^k + K ■ ö^j!^.,9 > dij (5.60a) 

Xi,k-i - xj^k + K ■ l^lkM) > dij (5.60b) 

-Ui.k-i ^- iJj,k + K- If^t, ,^ > dij (5.60c) 

yLk-i-yj.k + l<-t^lkA2>äij (5.60d) 



12 



/=9 



E^S!m<3 (5.60e) 
/j=L...,2; ?: = 1,...,A/, j = i+ly...,M (5.60g) 



fo^j'^., G {0,1}, / = 9,...,12 (5.60f) 



Die Abstände f/,,, müssen an die auftretenden Fahrzeuggeschwindigkeiten und an 
das Abtastintervall AI angepasst werden. Je stärker die Geschwindigkeiten variie- 
ren, desto konservativer iiuiss die Approximation gestaltet werden, und desto stär- 
ker wird die Menge der z.ulässigen kooperativen Bewegungspläne eingeschränkt. 
Ein weiterer Nachteil dieser Vorgehensweise ist die deutlich größere Anzahl bi- 
närer Variabler, die einen steigenden Rechenaufwand zur Folge hat. 

Dieses Vorgehen lässt sich auf eine (iberdeckung des Fahrzeugs mit einer größe- 
ren Anzahl von Quadraten verallgemeinern, indem weitere zeitlich benachbarte 
Positionen berücksichtigt werden. Außerdem können anstelle von Quadraten be- 
liebige regelmäßige Polygone mit Nij^k Kanten verwendet werden, ähnlich wie 
bei der Approximation des Kamm'schen Kreis im Gleichungssystem ( |5.54) . Auf 



diese Verfeinerungen wird hier verzichtet, da sie mit einer weiteren Erhöhung des 
Rechenaufwands verbunden sind. 
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5.4.2.2 Rechteckige Fahrzeuggeometrie 

Eine Alternative zur Miteinbeziehung der zeitlich benachbarten Positionen ist die 
Approximation der Fahrzeuggeometrie durch ein Rechteck mit fester Orientic- 
runs. Dieses Vorüehen erfolgt unter der Annahme einer beschränkten Orientie- 
rungsänderung des Fahrzeugs während des Planungshorizonis. Bei höheren Ge- 
schwindigkeiten und geringer Fahrspurkrümmung ist diese Annahme häufig ge- 
rechtfertigt. Die Orientierung des Rechtecks wird entsprechend der Anfangsori- 
entierung pio gewählt ( Abb. 5.l2(b)| . Wegen der Zeitdiskretisierung und der 



Vernachlässigung von Orientierungsänderungen müssen die Abmessungen f//.y,x» 
dij^y der Rechlecke die Fahrzeuggeomeirie überapproximieren. Mit dem Recht- 
eckmodell erhält man folgende Nebenbedingungen, die das System ( |5.58| erset- 
zen: 

(cos^i,o siii0v,,) • f ' t ' + ^ • KtkA > dij,^ (3.61a) 

(-sin<^,,o cos<?>,,o) • I^J-^) +i^-&d!.,3 > rfij,y (3.61c) 

(-smc>i,ü cos(5!>i,o) • +^-0,4 > <j,y ^5.61d) 

•1 

e {0^ 1}, /=!,..., 4 (5.610 

A = l,...,r, i=l,...,A/, j = /■ + 1,...,A/ (5.61g) 

Bei der Festlegung der Abslände d, j_y^, ^^/./.y werden die Anfangsbedingungen 
0f,ü. 0j,ü i'iid ^'f^i,o. ^^i^lj.i) sowie das Abtastintervall berücksichtigt. 



5.4.3 Modellierung der Straßenfläche 

Die Begrenzung der befahrbaren vStraßenfiäche stellt eine zusätzliche Nebenbe- 
dingung dar, die im Luftverkehr nicht auftritt. Prinzipiell ist es zwar möglich, alle 
Bereiche aul3erhalb des Straßennetzes als Hindernisse aufzufassen und wie oben 
beschrieben in das Modell aufzunehmen. Es ist jedoch naheliegender, die Fahr- 
zeugpositionen p^j, auf Enthaltensein in der StraBenfläche zu überprüfen. Auf 
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Abbildung 5.13: Approximation der zulässigen Straßenfläche durch konvexe Po- 
lygone (speziell Vierecke, Er = 1). 

diese Weise werden i.d. R. weniger binäre Variable benötigt als bei der Ilinder- 
nismodellierung, sodass eine schnellere Lösung des MILPs möglich sein sollte. 

Die zulässige Straßenfläche wird in R konvexe Polygone partitioniert ( jAbb. 5.13) . 
Die mögliche Größe der Polygone hängt vom Straßenverlauf ab: Gerade Straßen- 
abschnitte können als einzelnes Rechteck modelliert werden, während mit zuneh- 
mender Krümmung des Straßenverlaufs eine feinere Zerlegung erforderlich wird. 
Ein Polygon ist die Schnitmienge von E, Halbebenen, die durch Ungleichun- 
gen in Normalenform beschrieben werden. Ein Punkt p,,fc — , VKk)"^ ii^l genau 
dann im Polygon enthalten, wenn er die folgenden E, Ungleichungen erfüllt: 

An den Polygonkanten, die den Straßenrand modellieren, wird die Fahrzeuggeo- 
metrie mit eingerechnet, wodurch t/,./.» vom Fahrzeug c-, abhängt. Hierbei muss 
eine Approximation vorgenommen werden, weil die Information über die Orien- 
tierung des Fahrzeugs im linearen Modell nicht vorliegt. 

Jedes Fahrzeug muss sich zu jedem Zeitpunkt in einem der Polygone befin- 
den. Um diese Oder- Verknüpfung abzubilden, werden binäre Variable bYl^\j, ein- 
geführt. Es ist b^"l!]r = 0, wenn pi^k in i^^j enthalten ist. Die Nebenbedingungen 
für die übrigen R — l Polygone werden durch a'',. = 1 außer Kraft gesetzt. Ins- 
gesamt ergibt sich damit die folgende Formulierung für die Berücksichtigung des 
Straßennetzes in der MILP-Bewegungsplanung: 

"r,/.x • + nrj,, ■ yu- + A' ■ 6^.^, > rfr,/,i , 1=1,. ...Er (5.63a) 

R 

X]^a%r < 1 (5.63b) 
Cav€{U-U- ''-^ A--l,....r, i-l....,M (5.63c) 



i- T 
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5.4.4 Erreichbarkeitsbctrachtuiigcn 

Wegen seiner Dynamik kann ein Fahrzeug innerhalb eines gegebenen Zeitinter- 
valls nur eine begrenzte Strecke zurücklegen. Daraus lassen sich mit einfachen 
Überlegungen Schranken für seine Positionen p,./, herleiten. Wenn sich ein Hin- 
dernis außerhalb der erreichbaren Positionen befindet, ist eine Kollision zu die- 
sem Zeitpunkt ausgeschlossen. Daher kann im MILP auf die entsprechenden Ne- 
bcnhedingungcn und binären Variablen verzichtet v^'crden. Auf diese Weise kann 
i.d. R. bei der Lösung des MILPs Rechenzeit eingespart werden. Ähnliches ist 
auch für die Nebenbedinungen möglich, welche die kooperative Kollisionsvermei- 
dung und das Straßennetz beschreiben. 

Ausgehend von der Anfangsposition p,.o muss sich Fahrzeug nach der Zeit 
k ■ i^t innerhalb eines Bereichs mit den folgenden Grenzen befinden: 



•^i.AMiiiii 


< 














(5.64a) 


^V»,A,min 
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(5.64b) 


•^t,A-,min 
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• ÖCC,- x.min 


(5.64c) 


♦^t.fc.max 






•k 
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■{k-Atf 


• <tCCix,mä\ 


(5.64d) 


l/j.A:,min 




Ui^o + veli^o,y 
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At + 


1 
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(k-Atf 


^^^i ,y.mtn 


(5.64e) 


2/».A;,max 




yi,o + vdiß^y 


k 


At + 


1 
2 


■{k-Atf 




(5.64f) 



Die minimalen und maximalen Beschle unigungen o^'t'j.x.min"' • • • • ^■''^^t.y.max entlang 



der Koordinatenachsen ergeben sich wie in Abschnitt 5.4. 1 aus dem Fahrdynamik- 
modell. 

Im Folgenden wird zunächst auf die Nebenbedingungen aus der kooperativen Kol- 
lisionsvermeidung und anschließend auf die des Straßennetzes eingegangen. Das 
Vorgehen für die Hindernisse ist sehr ähnlich und wird deshalb nicht weiter erläu- 
tert. 

Zunächst wird ein Block von A',.j,a Ungleichungen betrachtet, der die Kollisi- 
onsvermeidung zwischen den Fahrzeugen und cj zum Zeitpunkt A- • At model- 
liert. Die Ungleichungen sind durch binäre Variable odcr-vcrknüpft. Im Beispiel 
des Ungleichungssystems (j538) ist A^,.yjt = 4. Unter Umständen kann mit Hilfe 
der Erreichbarkeitsbetrachtungen festgestellt werden, dass einzelne dieser Unglei- 
chungen für jeden möglichen kooperativen Bewegungsplan erfüllt sind. Bei Un- 
gleichung ( 5.58a| ist dies beispielsweise der Fall, wenn 



*^j,fc,inin *^ t,Ac,max ^^ ^^t.j (5.65) 

gilt. Anschaulich bedeutet dies, dass alle erreichbaren Positionen von Fahrzeug Cj 
weit genug östlich von allen erreichbaren Positionen von Fahrzeug r, liegen, um 
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+ 



■^i.A:,max •^j,k,min 

(a) 



y 




H h 



•^i,k. min •^j,A-,inax 

(b) 



Abbildung 5.14: Erreichbarkeitsbetrachtungen zur Elimination von binären Va- 



riablen in der MILP-Formulierung. (a) nach ( |5.63| , > ü, (b) nach i\^.66) . 



eine Kollisionsvermeidung sicherzustellen l Abb. 5.14(a)^ . Entsprechende Bedin 



gungen lassen sich auch für die anderen Ungleichungen aus ^5.5S\ formulieren. 
Die Anzahl der auf diese Weise als erfüllt erkannten Ungleichungen in dem Block 
wird mit A''™\ bezeichnet. Wegen der Oder- Verknüpfung genügt A^.™^^. > 1, um 
eine Kollision von c, und cj zum Zeilpunkt k • At für alle kooperativen Bewe- 
gungspläne auszuschließen. Daher kann in diesem Fall der entsprechende Block 
l |5.58) aus dem MILP entfernt werden. Die zugehörigen binären Variablen 



Ni j,k, werden nicht mehr benötigt. 

Umgekehrt können mittels Erreichbarkeitsbetrachtungen auch Ungleichungen 
identifiziert werden, die auf keinen Fall erfüllt sein können. Für Ungleichung 
(5380} lautet die entsprechende Bedingung 



"^j^k^max *^ ^i./c.nriin "1" i (5.66) 

d. h. es gibt keinen kooperativen Bewegungsplan, in dem sich Fahrzeug cj zum 
Zeitpunkt k ■ At so weit östlich von Fahrzeug Ci befindet, dass dadurch eine Kol- 
lisionsvermeidung erzielt wird (lAbb. 5. 14(b) . Sei A^f'j'*^, die Anzahl der Unglei- 
chungen, die gemäß den Erreicnbarkeitsbe trachtungen nicht erfüllbar sind. Die- 



chungen, die gemäß den Erreichbarkeitsbetrachtungen nicht erfüllbar sind. Die 
se Ungleichungen und die zugehörigen binären Variablen j können aus der 
Oder- Verknüpfung ( |5.58| entfernt werden. Ungleichung lj538c) muss angepasst 
werden zu 
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um weiterhin eine Oder- Verknüpfung der verbleibenden Nebenbedinungen zu er- 
zwingen. Die Summalion in ( .S.67f erfolgt über die Indizes / der verbleiben- 
den binären Variablen If^^j^^ Ein Sonderfall ergibt sich, wenn nur noch eine 
Ungleichung übrig bleibt, A''*'J^^, = A'/^^.ji, - 1. Dann können alle binären Varia- 
blen /=1 A'j,^-, sowie Ungleichung ( 15.67[ t entfallen. Es gilt stets 



Zusammenfassend können folgende Fälle unterschieden werden: 



1. A' l''"'^^. > 1 : Eine Kollision der Fahrzeuge Ci und Cj zum Zeitpunkt A- ■ 
ist ausgeschlossen. Daher kann auf die binären Variablen ^^'j'^.. , für alle 



/ = 1 ^'i,j,k und auf die entsprechenden Nebenbedingungen (538} ver 

ziehtet werden. 



A^^;^. - 0 A U < Nf^ < Ni,,_^ - 2: Es werden A^/.^.a- - Nj"^ Neben- 
bedingungen aus ( 5.58| und ebensoviele binäre Variable ^^^''j'^^ in das 
MILP aufgenommen. Zusätzlich wird ( |5.58e{ i modifiziert zu Yli^Tjki — 
^'i,j,f^' ~ ^'ijk ~ 1- Damit werden N^Yk t^i'iäre Variable eingespart. Im Fall 
0 sind keine Nebenbedingungen aufgrund dieser Erreichbarkeitsbe- 



A 



rfalse 



trachtungen verzichtbar, und es ergibt sich die ursprüngliche Formulierung 
(538). 



\rtrue 



0 A A^''»'.'?. 

t.l.k 



^'i. j.k — l'- Es wird genau eine der Nebenbedingungen 

aus ( )5.57| benötigt. Auf die binären Variablen />^'*'j',, / = 1 A', j.a , kann 

verzichtet werden. 



^ Yi-'j^^^ A^j.y j,.: Im Rahmen der Approximationsgenauigkeit des MILP- 
Modells existiert kein kooperativer Bewegungsplan, der die Kollision der 
Fahrzeuge und Cj zum Zeitpunkt k • At verhindern kann. Durch die Er- 
rcichbarkcitsbctrachtung wird in diesem Fall frühzeitig festgestellt, dass die 
betreffende Problcminstanz für das Verfahren nicht lösbar ist. 



Bei dem Modell mit Vorgänger- und Nachfolgerpositionen aus Abschnitt 5.4.2. 



werden die Ungleichungssysteme ( |5.58^ ^ j53ö" i und ( 5.60) separat betrachtet. Für 



das rechtcckitze Gcometricmodell aus Abschnitt 5.4.2.2 können die beschriebenen 



Erreichbarkeitsbetrachtungen auf das System ( 5.6 Ij ! angewendet werden. 



Ein ähnliches Vorgehen ist auch für die Nebenbedingungen möglich, welche die 
Straßenfläche beschreiben. Hier wird untersucht, welche Polygone der Straßen- 
flächc eine nichtlcerc Schnittmenge mit den erreichbaren Positionen von Fahrzeug 
Ci zum Zeitpunkt k ■ haben. Nur die.se Ri ^ Polygone und ebensoviele binäre 
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Variable werden in das Unglcichungssystem ( 5.63^ aufgenommen. Die Un- 
gleichung ( |5.63b^ wird modilizieri zu ^T'kr - ^'^^ ~ ^' ^'^^^ ^i^^ ~ ^ '^^"'^ 
auf sämtliche binäre Variable V^^ff^., r—\ R, verzichtet werden. In den meis- 
ten Fällen ist -C R, sodass zahlreiche binäre Variable eingespart werden kön- 
nen. Auf geraden Straßenabschnitten und für kleine A: ist häufig sogar = 1- 



5.5 Elastische Bänder 

Ein elastisches Band ist eine Folge von Knoten, bei der an jedem Knoten eine 
Position annotiert ist. Auf die Knoten wirken Kräfte ein, die das Band von Hin- 
dernissen abstoßen und einen glatten Verlauf des elastischen Bands erzwingen. 
Ursprünglich wurde die Methode der elastischen Bänder zur lokalen Anpassung 
von Roboterbahnen an veränderte Umgebungsbedingungen, insbesondere an be- 
wegte Hindernisse, entwickelt und eingesetzt jQmnLin^)3[ [Qiiinl.in^j4[ |Kli.iiih971 



|Brock99l Philippsenü3 |Komainda03| . Hierbei ist jedem Knoten zusätzlich zu der 



Position des mobilen Roboters auch eine Freiraumbeschreibung zugeordnet. Die 
Vereinigung aller Frciraumbercichc des elastischen Bands garantiert die Kollisi- 
onsfreiheit der Bahn. Bei der Bahnanpassung kann es erforderlich sein, neue Kno- 
ten in das Band einzufügen. Die initiale Bahnplanung muss mit einem anderen 
Verfahren durchgeführt werden, da diese Variante der elastischen Bänder nur zur 
Anpassung einer bereits bekannten kollisionsfreien Bahn eingesetzt werden kann. 

Die Methode der elastischen Bänder wird auch zur Bahn- und Bewegungsplanung 
für Fahrzeuge eingesetzt |Hilgeri03 !Hesse07bllHesse ÖTäliVVillelOl . Da bei dieser 



Anwendung keine kollisionsfreic initiale Bahn bekannt ist, wird auf das Konzept 
der Freiraumbe.schreibungcn verzichtet (üehrjgÜVj. Ein Knoten repräsentiert die 
r^ahrzeugposition zu einem festgelegten Zeitpunkt, wodurch eine Bewegungspla- 
nung inöglich wird IBrandtO.'Sbl . Bei dieser Variante des Verfahrens ist die Anzahl 
der Knoten konstant. Es werden keine Knoten eingefügt oder gelöscht. 

Die virtuellen Kräfte zur Abstoßung des Bands von Hindernissen können ähnlich 
modellicri werden wie bei lokalen Potenzialfeldplanungsalgoritlimen llKhatib861 



Barraquand92). Zusätzlich wirken jedoch innere Kräfte entlang des elastischen 



Bands, die einen glatten Verlauf erzwingen und notwendige Ausweichbewegungen 
entlang des Bands propagieren, sodass eine Vorausschau innerhalb des gewählten 
Zeithorizonts möglich wird. 

Häufig werden die Knoten und die virtuellen Kräfte eines elastischen Bands in 
Analoeie zu einem mechanischen Feder-Masse-System und den darin auftretenden 
realen Kräften gesehen IBrandtü5b| . Auch zu den chemischen Bindungskräften in 
Molekülen besteht eine gewisse Ähnlichkeit ILaValleOOl . 
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Im Folgenden wird ein Verfahren zur kooperativen Bewegungsplanung in Gefah- 
rensituationen vorgestellt, das auf der zweiten, fQr den Fahrzeugbereich angepass- 
ten, Variante d^ elastischen Bänder aufbaut 



5.5.1 Notation 

Die geplante Bewegung des Fahrzeugs <■,, > €- {l. W}. wiixl durch ein ehisti- 

sches Band miidelliL-ri. Ein Band besteht aus T I 1 KnoiL-n. Jeder Knoten repräsen- 
tiert die Position des Falirzeugs zu einem festgelegten Zeitpunkt innerhalb des Pla- 
nungshorizonts. Es wird eine äquidistante Zdtdidaetisiaiing mit einem Abtastin- 
tervall von At gewählt Somit ergibt sich ein Planungshorizont von ti, = T • At. 
Eine nicht äquidistante Zeitdiskretisierung ist grundsätzlich denkbar, würde aber 
die Modellierung der Kräfte erschweren. Die Knoten werden mit pi^k bezeich- 
net und mit der Fahrzeugposition pi^k = (^t,ibi yi,k)'^ zum Zei^unkt tk := k- At 
identifiziert (A; = 0, . . . ,T). Der Knoten pi,o entspricht der Anfangsposition des 
Fahrzeugs Cj. 

Die Orientierung (/>, des Fahrzeugs in der Strafienebene stellt bei dieser Model- 
lierung keinen expliziten Parameter dar, sondern ergibt sich aus der Abfolge der 
Knoten. Eine Näherung für die Orientierung 0^ zum Zeitpunkt k * At kann wie 
folgt berechnet werden: 

^ik = arctan ~ , fe=l,...,r (5.68) 
Xi^k — ^i,k-l 

In ähnlicher Weise ist die Geschwindigkeit veli^k zum Zeitpunkt k - At näherungs- 
weise gegeben durch 

vek., = ^^^'-^ ~ "•'-'^l^ ^^'-^ - . k=l,...,T. 15.69, 

Orientierung (pj^o und Geschwindigkeit veli^o zum Zeitpunkt t = 0 sind aus dem 
Anfangszustand xf"* des Fahrzeugs bekannt. 

Auf einen Knoten pu wirkt die virtuelle Kraft f/j. — (/;.;, a- .A.A.- .y)^ ein. Diese 
resultierende Kraft setzt sich aus melireren Einzelkräften zusammen, die im fol- 
genden Abschnitt beschrieben werden. 



5.5.2 ModeUienuig der Kräfte 

Die Einzelkräfte können unterteilt werden in innere Kräfte, äußere Kräfte und ko- 
operative Kräfte. Die mneren Kräfte wuken zwischen benachbarten Knoten pi^k* 



Oüpy tiyhioo inatotial 
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Pi^k+i eines elastischen Bands. Sie erzwingen die Einhaltung der kinematischen 
und dynamischen Beschränkungen des Fahrzeugs. Zu den inneren Kräften gehören 
die longitudinale Kraft f'''" und die laterale Kraft f'"^'. 

Die kooperative Kraft f'-'^'^ wirkt zwischen Knoten pj.^, Pj.A: zweier verschiedener 
elastischer Bänder (i/j), um eine Kollision der beiden kooperativen Fahrzeuge 
c, und Cj zu verhindern. 

Die äußeren Kräfte wirken zwischen einem Knoten p,,/, und einem anderen Ob- 
jekt. Hierzu zählen die Straßenrandkraft f""'^, die das elastische Band auf der Stra- 
ße hält, und die Hinderniskraft P^'^', die das Band von unbewegten oder bewegten 
Hindernissen abstößt. 

Alternativ zu der in dieser Arbeit verwendeten Kräfteformulicrung können skalare 
Potcnzialfeldcr für die einzelnen Anforderungen definiert werden IBrandtO^hl . Für 
wirbelfreie Kraftfelder sind beide Betrachtungsweisen weitgehend äquivalent: Die 
Kräfte entsprechen den Gradienten der Potenzialfeider lMasoud97)llKoseckä97l . 



5.5.2.1 Longitudinale Kraft f'"" 

Die longitudinale Kraft bewirkt einen glatten Verlauf der Längsbewegung und 
erzwingt die Einhaltung der fahrdynamischen Beschränkungen in longitudinaler 
Richtung. Indem ein Knoten von seinen beiden Nachbarn angezogen oder abge- 
stoßen wird, wird eine Bewegung mit konstanter Längsgeschwindigkeit bevorzugt: 



flon . flon ?lon 
flon . Ion 



Pi,k - Pi,A— 1| 



k=l,...,T-\ (5.70a) 
{Pi,k - Pi.k-i) . k-h....T (5.70b) 



w^i^ := - Api^k + (ma.x{0, acci^m\n - acc-i^k + 1})^ 

- (lliax{0, aCCi^k - «CC/,niax + 1}) 

- tigii{acci^k) ■ (max{Ü, acc,;,A-,rcs - Pi ■ yc + i))' 

. . velj^k + v elj^k- i 
^Pi^ '= h,k 2 ^ 

h,k '■= yj {xiM - Xi^k-iV + (yi.k - yi.k—i)' 



acci^k = 2 



t,A: 



(5.70c) 

(5.70d) 
(5.70e) 
(5.70f) 



Die einseitige Kraft f!*"^ wirkt immer entlang des elastischen Bands (lAbb. 5. 15(a) 



Die skalare Gewichtung Jir"J! hängt zunächst von der Differenz Api k zwischen 
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\>i.k I 1 




(a) longitudinale Kraft (b) laterale Kraft 

Abbildung 5.15: Veranschaulichung der inneren Kräfte. 
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(a) longitudinale Kraft (b) laterale Kraft 

Abbildung 5.16: Skalierungsfunktionen der inneren Kräfte. 



dem Abstand bei konstanter Geschwindigkeit und dem aktuell vorliegenden Kno- 
tenabsland ab. Im Fall einer Längsbeschleunigung ist A/j, j; > U, und die longitu- 
dinale Kraft f'"^^ zieht p, in Richtung Pij;-[. Bei einer geplanten Bremsverzö- 
gerung ist Api^k < 0, und der Knoten p^.A wird von p,,A-i abgestoßen. Für eine 
Bewegung mit konstanter Längsgeschwindigkeit ist Api_f,. = 0, und die longitudi- 
nale Kraft verschwindet. Zusätzlich bewirken die quadratischen Tcrmc in ( 5.7ücf 
einen steilen Anstieg von n-\'"j^, sobald die approximierte Beschleunigung arcj /^ 
die fahrdynamischen Grenzen aus Abschnitt 5.3.2.1 überschreitet ( Abb. 5.16(a)| . 
Die ersten beiden Terme setzen die Intervallbegrenzung I"^''',,min^ «'"fj.maxj für 
die Längsbeschlcunigung durch, der dritte Tcrm die Bedingung des Kamm'schcn 
Kreises ( 5. 1 2| l. Die darin auftretende Gcsamtbcschleunigung ncci^k.rcs wird im fol- 
genden Abschnitt bestimmt. 

Für den Knoten p;,o müssen keine virtuellen Kräfte berechnet werden, da er un- 
veränderlich an die Anfangsposition des Fahrzeugs gekoppelt ist. Beim letzten 



Knoten wird f]';^ 



f;;'f gesetzt. 



122 



5 Bewe^itneisplünunQ: für kooperierende Fahrzeuge 



5.5.2.2 Laterale Kralt f 



Die laterale Kraft glättet die geplante Bewegung quer zur Fahrtrichtung und setzt 
die fahrdynamischen Beschränkungen an die Querbeschleunigung durch. Der be- 
vorzugte (ileichgewichlszusland ist die (ieradeausfahrt. Ebenso wie die longitudi- 
nale Kraft wird die laterale Kraft in symmetrischer Weise für die beiden benach- 
barten Knoten de liniert: 



^^Ck '■= \^r^- - \ + {inax{ü. |acC,-,A.,|at| - «CCijai,m.ix + i}) 



+ (inax{(). «C-Q,A,rcs - fli - (k- + 1})' 



(5.71c) 



acCi^kM = K'i,k ' veli k (5.7 Id) 



««"i.A. .es 



yjaccl^ r <inii,^i^ (5.71e) 



Der Richtungsvektor von f'''!. zieht den Knoten p, /, zu der Position, die sich 



bei (ieradeausfahrt in Richtung vom Knoten P/.a_i ergibt ( Abb. 5.15(b)| . 



Der Knoienabstand wird dabei nicht verändert, sodass laterale und longitu- 
dinale Kräfte weitgehend voneinander entkoppelt sind. Die skalare Gewichtung 
w^^\. wird für kleine Querbeschleunigungen proportional zur Orientierungstliffe- 
rcnz \(f)i.(^ — (pi^k-] I gewählt, bei deren Berechnung selbstverständlich die Identi- 
tät der Winkel 0 und 27r berücksichtigt werden muss. Ebenso wie bei der longi- 
tudinalen Kraft werden zusätzliche quadratische Ternie definiert, die im Fall ei- 
ner Verletzung der fahrdynamischen Grenzen einen steilen Anstieg von //'l"'^, be- 
wirken ( Abb. 5.1 6(b)| . Der erste dieser Terme modelliert die Beschränkung der 



Querbeschleunigung f rr, A ja, auf das Intervall | — lat.max. ^^^■Cj.iat.max)' der zwei- 
te den Kamm'schen Kreis ( )5.12| i. Die Querbeschleunigung acci j; ]^^^ am Knoten 
p,,A wird aus Geschwindigkeit and Bahnkrümmung berechnet. Die momentane 
Bahnkrümmung k,-,a wird unter der Annahme einer Kreisfahrt von p/,A i nach 
p, A approximiert. Für den Kamm'schen Kreis wird der Betrag flccj,A.-,res der Ge- 
samtbeschleunigung bencHigt, der sich aus der Läng.sbeschleunigung ncci und 
der Querbcschleungigung ««^f^.A-.iat bestimmen lässt. Die nichtholonomc Kinema- 
tik wird hier nicht explizit berücksichtigt, weil hei höheren Cieschwindigkeiten 
die dynamischen Beschränkungen restriktiver sind. Zur Verwendung eines detail- 
lierteren Fahrzeugmodells im Rahmen der Methode der elastischen Bänder siehe 
BHesse07al . 
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5.5.2.3 StralJenrandkralt f 

Die Kraft f["^''' stößt den Knoten p,.;. vom StraBenrand ab, um die Bewegung des 
Fahrzeugs r, auf der Straßenfläche zu halten. Für einen Straßenabschnitt r be- 
schreiben die Funktionen f^^"f^''|,(p) und '^^,'7M.ht(P) Abstand des Punktes p vom 
linken bzw. rechten Straßenrand. Sie nehmen positive Werte an, wenn sich der 
Punkt auf der Straßenfläche befindet, und negative Werte, wenn der Punkt in der 
entsprechenden Richtung außerhalb der Straße liegt. Die Berechnung erfolgt mit 
I lilfe des Geometriemodells der Straße ( siehe Abschnitt 3.3. 2| . Das Minimum die- 



ser beiden Funktionen stellt den Abstand vom relevanten Straßenrand dar: 

/ro;nJ/„\ . f ,/ro,id ,n"nad 



<-^(p):=miii{<i:^,(p). <-:;jp)} (5.72) 

Nun wird derjenige Straßenabschnitt bestimmt, auf dem sich der Knoten p,./. ak- 
tuell behndetü 

n.fc :=argTnax <f;:''\\>i.k) (5.73) 

r9 Rands 



Im Fall von mehreren überlappend modellierten Straßenabschnitlen stellt der am 
weitesten entlernte Straßenrand die tatsächlich relevante Begrenzung dar. Dies 
wird durch die Ma.ximierung in ( 5 .731 berücksichtigt. 



Der sewünschie Mindestabsland des Fahrzeugs c: vom Straßenrand wird in 
Abhängigkeit der Fahrzeugabmessungen bestimmt. Falls der Knoten pi_^, zu nah 
am Straßenrand liegt, wird er in Richtung des Normalenvektors ii,^ ^. (p,.;,) des 
Straßenverlaufs am Ort p, zur Straßenmitte gezogen: 

■ lK':::Sn-c'(P'-A))-".,..(p.;>) faiis<^;(p,,o<'^^^;:^n 

Auf der linken und auf der rechten Seite der Straße gibt es jeweils eine Fläche 
der Breite c/y^lln, in der ein Knoten p;./, vom Straßenrand abgestoßen wird. In der 
verbleibenden Fläche in der Straßenmitte verschwindet die Kraft f]''/"^. 

Nach dem gleichen Prinzip kann ein Knoten, der sich außerhalb des Straßennel- 
zes befindet, zurück auf die Straßenlläche gezogen werden. Ferner können Kräfte 
nicht nur bezogen auf Straßen, sondern auch bezogen auf Fahrspuren definiert 
werden. Beispielsweise ist es möglich, die Knoten hin zur Fahrspurmitte zu zie- 
hen, sodass eine Bewegung entlang einer Trennlinie zwischen zwei Fahrspuren 
vermieden wird. Außerdem können Kräfte definiert werden, die den Term Z.-""' 
aus l 5.24a| abbilden und eine Bewegung auf der gewünschten Fahrspur bevor- 



zugen. Auf solche Erweiterungen wird in dieser Arbeit verzichtet, da sie für die 
kooperative Kollisionsvermeidung zweitrangig sind. 



■'Hier und im restlichen .Abschnitt 5.5.2 durchlauft k die Werte 1 , . . . . T und i wie bisher 1 M . 
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5.5.2.4 Kraft zwischen kooperativen Fahrzeugen 

Um Kollisionen zwischen kooperativen Fahrzeugen zu vermeiden, wird eine ab- 
stoßende Kraft f^'Jl zwischen den Knoten p,.;^, p,,^. zweier Fahrzeuge c,, Cj defi- 
niert. Die Kraft w irkt nur zwischen Knoten mit dem gleichen Zeitindex k, sodass 
Fahrzeuge zeitlich nacheinander denselben Bereich der Straße befahren können. 
Voraussetzung für eine erfolgreiche Kollisionsvermeidung ist eine ausreichende 
örtliche Autlösung durch die diskreten Knoten der elastischen Bänder. Daher muss 
das Abtastinlervall At in Abhängigkeit der Fahrzeuggeschwindigkeiten entspre- 
chend gewählt werden (siehe auch Abschnitt 6.4.1.4) . 



Ein erster Ansatz für die Kraft zwischen kooperativen Fahrzeugen könnte wie folgt 
aussehen: 



+ • n)ax{n. lo,., - - f } • ( '^i;' ] 

Der erste Summand bewirkt, dass P(.A umso stärker von p^j, abgestoßen wird, 
je geringer der euklidische Abstand zwischen den beiden Knoten ist. In den Fak- 
tor pij >(), der den exponentiellen Abfall der Kraft mit zunehmendem Abstand 
bccinfiusst, gehen die Abmessungen der Fahrzeuge ein. Der zweite Summand be- 
vorzugt bei entgegenkommendem Verkehr (|<?>j,A — ^j.fcl > f) ein Ausweichen 
nach rechts. Er wird über den Faktor A"^' > 0 deutlich geringer gewichtet, sodass 
er lediglich die Auswahl der Ausweichrichtung im Fall von sehr nahe beieinander 
liegenden Falirzeugpositionen steuert. 

Mit dieser Modellierung tritt jedoch das Problem auf, dass die Kräfte benachbarter 
Knoten in unterschiedliche Richtungen zeigen und so zu einer gegenseitigen Blo- 
ckierung führen können. Dieser Effekt ist bei cntueiienkommenden Fahrzeuiicn 
besonders ausgeprägt ( |Abb. 5.1 7(a)| . Die inneren Kräfte verhindern ein beliebiges 
Auseinanderziehen der Knoten und heben dadurch die Wirkung der abstoßenden 
Kräfte auf. Die elastischen Bänder „verklemmen" sich und können nicht mehr ge- 
geneinander verschoben werden. Um diesen Effekt zu verhindern, wird eine Mit- 
telung der Kraftvektoren über das gesamte elastische Band hinweg durchgeführt. 
Dadurch greift an allen Knoten eine Kraft f^^l mit identischem Richtungsvektor 
an, die wie bisher mit einem exponentiellen Faktor in Abhängigkeit des Abstands 
zum anderen Fahrzeug skaliert wird: 

f^;^?P := e-P'-^ • IIP^'^-P.'-^- " • ^ • 51 ^ijA (5.76) 

/ 1 
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(a) (b) 

Abbildung 5.17: Veranschauiichung der Kräfte zwischen kooperativen Fahrzeu- 
gen. 

Durch die Mittelung werden alle Knoten parallel in eine gemeinsame Ausweich- 
richtung verschoben (Abb. 5. 17(b)^. Gleichzeitig wird das andere beteiligte Fahr- 



zeug Cj in die entgegengesetzte Richtung gedrückt. Außerdem werden die inneren 
Kräfte nicht mehr daran gehindert, das elastische Band senkrecht zu dieser Aus- 
weichrichtung zu modifizieren. Damit sind beispielsweise Bremsmanöver vor dem 
gegenseitigen Passieren der beiden Fahrzeuge möglich. 

Schließlich wird die Kraft über alle von c, verschiedenen Fahrzeuge aufsum- 



mieri: 



j = l,...,A/ 



5.5.2.5 Hinderniskraft f 



Die Vermeidung von Kollisionen mit stehenden und be wegten Hin dernissen kann 
in ähnlicher Weise mit einer Kraft ff^^^ erreicht werden (Abb. 5.18 : 



iilnl 
) 



1 



Ip^^-PmI 



I 



{Pi.k - Ptk) (5.78a) 



(5.78b) 



fobsX \ ^ robsl 



(5.78c) 



Die Position des J-ten der Av,bsi Hindernisse zum Zeitpunkt k ■ Af wird darin mit 
p'J*^^' bezeichnet. Die Hindernis- und Fahrzeuggeometric geht in die Konstanten 

und cff;f ein. 
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Abbildung 5.18: Veranschaulichung der äußeren Kräfte. 



Pi,o 

D D O O O 




Abbildung 5.19: Visualisierung elastischer Bänder und ausgewählter Einzelkräfte. 



Die Modellierung der Kräfte f*^*"", f^^'^P und P'"*' basiert auf einer kreisförmigen 
Hindernis- und Fahrzeuggeometrie. Beispielsweise entspricht d^^j^ in (j5JH} der 
Summe der Radien der approximierenden Kreise zum ?'-tcn Fahrzeug und j-ten 
Hindernis. Objekte mit einer stark von einer Kreisform abweichenden Geometrie 
können durch eine Überdeckung mehrerer Kreise modelliert werden (Hilgert03| . 
In vielen Fällen reicht aber die grobe Approximation durch einen Kreis bereits 
aus, da sich die abstoßenden Kräfte von benachbarten Knoten über die inneren 
Kräfte auf das elastische Band ausbreiten und somit eine weiträumige Abstoßung 
von Hindernissen, von anderen Fahrzeugen und vom Straßenrand bewirken. Daher 
wird hier nicht näher auf die Überdeckung von Objekten durch mehrere Kreise 
eingegangen. 

[Abbildung 5.19 veranschaulicht die verschiedenen Einzelkräfte an einem Beispiel. 



5.5.3 Berechnung des Kräftegleichgewichts 

Zur Bewegungsplanung werden die virtuellen Kräfte iterativ auf die elastischen 
Bänder angewandt, bis sich ein Kräftegleichgewicht einstellt. Die Knotenpositio- 
nen in diesem Gleichgewichtszustand beschreiben dann den resultierenden koope- 
rativen Bewegungsplan. 



5.5 FAastisrhe Bänder 



Ml 



Zunächst müssen die elastischen Bänder geeignet initialisiert werden. Die Wahl 
der Initialisierung ist wichtig, da sie das Ergebnis der lokalen Optimierung beein- 
flussen kann. Daher sollte sie dem gewünschten Bevvegungsplan bereits möglichst 
nahe kommen. Aus diesem Grund wird eine Initialisierung verwendet, die zwei 



An fordern nijcn aus Abschnitt 5.1 bereits erfüllt, nämlich die StraBenucometric be- 



rücksichtigt und Längsbeschleunigungen vermeidet. 

Die Knotenpositionen p^*;,' zum Startzeitpunkt der Bewegung ergeben sich aus 

den Anfangszuständen xf'"^ der Fahrzeuge. Die weiteren Knoten p*')^', k = 
1 r, werden so initialisiert, dass sie ein Fahrspurfolgeverhalten mit kon stan- 
ter Geschwind igkeit abbilden. Dies entspricht der Handlung ^i';'"'-"'-™^' aus Ab- 
schnitt 5.3.2.2 Initial verschwinden daher die Kräfte fj^ und f[');"'. da die Knoten 
mit konstanter! Abständen in der Fahrspurmitte liegen. 

Die Knoten p, n bleiben fest an den Anfangspositionen. Für die übrigen Knoten 
p, k ~ \ T, wird die resultierende Kraft f , /, berechnet, die sich als gewich- 
tete Summe der modellierten Einzelkräfte ergibt: 

A'^'" • fj;^ + A'-" ■ f;;j^ + A^"''^' • i^if + A'""P ■ + A"^'-' • f;;*^' (5.79) 

In jeder Iteration j = 1, 2, . . . w erden die Knoten entsprechend den virtuellen Kräf- 
ten verschoben: 

P!^'*:=p!f^ + ''r<l? A- = l....,r (5.80) 
p;i'":=pi;^ (5.81, 

Die Knotenpositionen nach der ;-ten Iteration werden mit p*''^^ und die daraus be- 
rechneten resultierenden Kräfte mit f^' j, ' bezeichnet. Die Schrittweite wird für 

jede Iteration invers proportional zum maximalen Betrag der Kräfte max/.A ||f/{.^|| 
bestimmt. Dadurch bleibt die maximale Verschiebung eines Knotens auf einen 
Bruchteil der Knotenabstände beschränkt. Zusätzlich wird in manchen Fällen die 
Konvergenz der Optimierung beschleunigt, wenn die Schrittweite im Laufe der 
Iterationen reduziert wird fGehrigOTj . 

Dieses Optimicrungsverfahren entspricht im Wcscndichcn einem Gradientenab- 
stieg. Eine Alternative stellt das Newton-Verfahren dar, das allerdings die zusätzli- 
che Berechnung von Ableitungen erfordert l |Quinlan'J4 |Brandi()5"bl . Beide Verfah- 



ren nehmen eine lokale Optimierung vor und können das Erreichen des globalen 
Optimums nicht garantieren. 

Eine Sonderbehandlung wird erforderlich, wenn eines der Fahrzeuge auf eine sehr 
nicdriee Geschwindigkeit abbremst. Dann ist die Definition der inneren Kräfte 
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nicht mehr anwendbar, da die Knoten zu dicht beieinander oder im Extremfall 
des Fahrzeugstillstands sogar exakt aufeinander liegen. Ein solches Segment eines 
elastischen Bands w ird im koopcraiive n Bewegungsplan durch die Ausführung der 



Handlung 0^"^" aus|Abschnitt 5.3.2.2 



ersetzt. 



Die Optimierung terminiert, wenn das Kräftegleichgewicht erreicht ist, d. h. wenn 
alle resultierenden Kräfte näherungsweise verschwinden: 

ViE{l,...,M} VA;G{l,...,r} llff^l^ll <£eb mit£EB>0 (5.82) 

Anschaulich gesprochen stellt der kooperative Bewegungsplan im Gleichgewichts- 
zustand einen Kompromiss zwischen den verschiedenen durch die Einzelkräfte 
modellierten Anforderungen dar. 

Die positiven Gewichtungsfaktoren in < |5.7Q^ werden so gewählt, dass die Beträ- 



ge der Einzelkräfte in einer vergleichbaren Größenordnung liegen. Damit wird 
der Tatsache Rechnung getragen, dass jede Einzelkraft eine Anforderung an den 
kooperativen Bewegungsplan modelliert, die für eine korrekte Kollisionsvermei- 
dung unverzichtbar ist. Die genauen Werte der Gewichtungsfaktoren sind nicht 
von entscheidender Bedeutung, da eine Einzelkraft stark ansteigt, sobald die von 
ihr durchzusetzende Forderung verletzt ist, und somit die anderen Einzelkräfte be- 
tragsmäßig deutlich übertrifft. 

Es ist auch möglich, die Parameter des Kräftemodells während der Optimierung 
anzupassen, falls bestimmte Anforderungen dauerhaft verletzt sind. In der vorlie- 
genden Arbeit wird diese Vorgehensweise für die Durchsetzung der fahrdynami- 
.schen Nebenbedingungen eingesetzt. Sobald ein Glcichtzcwichts/ustand erreicht 



ist, wird überprüft, ob die fahrdynamischen Grenzen üus |Abschnitt 5.3.2 eingehal- 
ten werden. Falls sie verletzt sind, werden die Gewichtungsfaktoren A'"" bzw. A'^' 
des betroffenen elastischen Bands erhöht. Anschließend wird die Optimierung mit 
den angepassten Parametern fortgesetzt. Ein ähnliches Vorgehen ist auch für die 
anderen Einzelkräfte f^""^^ und f"';-' denkbar. 

Der Rechenaufwand für die Methode der elastischen Bänder hängt von der An- 
zahl der Iterationen ab, die bis zum Erreichen des Kräftegleichgewichts erforder- 



lich sind. In jeder Iteration müssen die Kräfte gemäß den Gleichungen pJ 
( |5.78^ , etc. berechnet werden. Der Aufwand dafür beträgt im schlimmsten Fall 
(9(A/" T -\- M • A'obsi • T), ist also polynomiell in der Anzahl der Fahrzeuge und 
Hindernisse. Ähnlich wie bei der gemischt-ganzzahligen linearen Programmie- 
rung inlAbschnitt 5.4.4|lässt sich durch Erreichbarkeitsbetrachtungen der Aufwand 



zur Bereclinun«: der äußeren und kooperativen Kräfte reduzieren. 



5.6 Narhverarheiiung der kooperativen Bewegiingspläne 
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5.6 Nachverarbeitung der kooperativen 
Bewegungspläne 

Bevor ein kooperativer Bewegungsplan zur Ausführung an die Einzelfahrzeuge 
übermittelt wird, müssen in Abhängigtceit vom verwendeten Planungsalgorithmus 
verschiedene Nach Verarbeitungsschritte durchgeführt werden. Hierzu gehören die 
Interpolation diskreter Positionsangaben zu einer kontinuierlichen Trajektorie, die 
Korrckthcitsprüfung und die Berechnung des verbleibenden Toleranzspiclraums. 



5.6.1 Interpolation 

Die gemischt-ganzzahlige lineare Programmierung und die Methode der elasti- 
schen Bänder liefern als Ergebnis eine diskrete Folge von Fahrzeugpositionen. 
Um daraus eine kontinuierliche Trajektorie über der Zeit zu erhalten, wird eine 
Interpolation durchgeführt. Als Interpolationsmethode werden kubische Splines 
verwendet, die sich wegen ihrer Glattheitseigenschaften und der Verfügbarkeit ef- 
fizienter Algorithmen zu ihrer Berechnung und Auswertung anbieten. Kubische 
Splines wurden in ähnlicher Weise bereits in zahlreichen anderen Arbeiten einge- 
setzt |I lilgert()3] iBrandtO.'^bi iWillc 1 ()|. Zur Eignung kubischer Splines gibt es in 



der Literatur allerdings auch gegenteilige Ansichten | |Dolgov08) . 

Die Interpolation wird für jedes Fahrzeug c, separat durchgeführt. Eingabedaten 
sind die diskreten Stützpunkte p/,^ zu den Zeitpunkten tk = k- At, k = 0, . . . ,T, 
sowie als Randbedingungen die Orientierung und Geschwindigkeit des Fahrzeugs 
zu den Zeitpunkten und fr. Damit ist die B-Spline-Repräsentation der inter- 
polierenden Kurve eindeutig bestimmt. In der Kontrollpunktdarstellung kann sie 
durch die Lösung eines dünn besetzten, 2- (T -|- 3)-dimensionalen linearen Glei- 
chungssystems berechnet werden |Praut/sch02| . Damit hat man eine parametri- 
sche Kurve 

r [ü, tr] - IR' 

y f ^ Pi = {xi,yi)' 

mit 7,(/a ) ~ Pi,k- Die Auswertung der Kurve an der Stelle / ist mit dem Algorith- 
mus von de Boor effizient möglich. Dabei erhält man ohne zusätzlichen Aufwand 
auch den Tangentenvektor an ')i{t), aus dem sich Orientierung und Geschwindig- 
keit des Fahrzeugs zum Zeitpunkt t bestimmen lassen. 
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5.6.2 Korrektheitsprüfung 

Manche Bcvvcgungsplanungsvcrtahrcn können aufgrund ihres approximativen 
Charakters nicht garantieren, dass ein korrektes Ergebnis zurückgeliet'ert wird. 
Vielmehr kann es in seltenen Fällen zu einem kooperativen Bewcgungsplan kom- 
men, der nicht kollisionsirei ist oder die fahrdynamischen Beschränkungen ver- 
letzt. Das ist schon deshalb nicht zu vermeiden, weil nicht bekannt ist, ob zu der 
aktuell vorliegenden Situation überhaupt eine korrekte Lösung existiert und weil 
diese Information auch nicht effizient berechnet werden kann. Je nach Anwen- 
dungsszenario bleiben im Falle eines nicht korrekten Bewegungsplans folgende 
Handlungsmöglichkeilen: 

• Unter Umständen kann es trotzdem sinnvoll sein, den kooperativen Bewe- 
gungsplan auszuführen. Voraussetzung ist. dass der zu erwartende Verlust 
geringer ausfällt als beim Verzicht auf einen kooperativen Eingriff. Dies 
kann mit dem nachfolgend erläuterten Verfahren vor der Ausführung des 
kooperativen Manövers überprüft werden. 

• Sofern mehrere Planungsverfahren parallel ausgeführt werden, kann auf das 
Ergebnis eines anderen Verfahrens zurückgegriffen werden. 

• Es kann eine Rückfallstrategie angewandt werden, beispielsweise eine Not- 
bremsung aller gefährdeten Ealirzeuge. 

• Auf einen kooperativen Eingriff wird verzichtet. Die Kollisionsvermeidung 
wird den Einzelfahrzeugen überlassen. 

• .'\uf einen automatischen Eingriff wird ganz verzichtet. Stattdessen werden 
die Fahrer der beteiligten Fahrzeuge vor der drohenden Kollision gewarnt, 
sodass sie ihrerseits kollisionsvermeidend handeln können. 



Die Korrektheit der geplanten Bewegung bezüglich der Fahrzeugdynamik kann 
anhand der zur Ausführung notwendigen Beschleunigungen geprüft werden. Sie 
ergeben sich aus den zweiten Ableitungen der parametrischen Trajektorie "),(/) aus 



Abschnitt 5.6. 1 Wenn die dynamischen Grenzen vom Planungsverfahren nur ap- 
proximativ berücksichtigt werden, kann es erforderlich sein, einzelne Stützpunkte 
der Beweuunu nachträulich zu korrigieren. Hierzu wird mit dem Fahrzeuszmodell 



(.•S.^i eine Bewegung des Fahrzeugs in Richtung des ursprünglichen Stützpunkts 
unter Einhaltung der kinematischen und dynamischen Beschränkungen simuliert. 

Die Kollisionsfreiheit eines Bewegungsplans lässt sich ebenfalls effizient überprü- 
fen. Hierzu werden die in einem Zeitintervall |^ i -\- 6i\ von den Fahrzeugen über- 
strichencn Flächen auf Di.sjunktheit getestet. Für dt — 0 erhält man ein bezüglich 
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des Auflösungsparameters 6t vollständiges Verfahren. Aus Gründen der einfachen 
Repräsentation wird hier allerdings eine Überapproximation der überstrichenen 
Flächen durch ein konvexes Polygon verwendet. Das Enthaltensein dieser Polygo- 
ne in der Straßenfläche kann ebenfalls effizient überprüft werden. 

Mit kooperativer Kollisionsvermeidung lassen sich in zahlreichen Verkehrssitua- 
tionen Unfälle verhindern. Auch wenn der eingesetzte Bcwcgungsplanungsalgo- 
rithmus in seltenen Fällen versagen kann, stellen die beschriebenen Maßnahmen 
sicher, dass selbst dann keine Verschlechterung gegenüber einem Fahrzeug ohne 
kooperative Kollisionsvermeidung eintreten kannP] 



5.6.3 Berechnung der Toleranz 

Wie in |Kapitel 3.2| erläutert, wird die detaillierte Trajektorienplanung und -glättung 
innerhalb der Toleranzvorgaben eines kooperativen Bewegungsplans von den Ein- 
zelfahrzeugen durchgeführt. Hierzu muss den Einzelfahrzeugen eine geeignete 
Repräsentation des Plans und der Toleranz übermittelt werden. Dies kann auf 
verschiedenen Abstraktionsebenen erfolgen. Die Auswahl der Abstraktionsebene 
hängt unter anderem von den Anforderungen der in den Einzelfahrzeugen einge- 
setzten Algorithmen ab. Eine symbolische Repräsentation könnte beispielsweise 
- in geeigneter Formali sierung - die folgende Anweisung enthalten: „Nach 2 Se- 
kunden links an Fahrzeug 7 vorbeifahren, anschließend auf Fahrspur 1 wechseln." 

Eine weniger abstrahierte Repräsentation wird im Folgenden exemplarisch vorge- 
stellt. Die Fahrzeugpositionen werden durch eine diskrete Folge von Konfiguratio- 
nen q, in der Ebene beschrieben. Die Zeitdiskretisierung kann ähnlich gewählt 



werden wie in den Abschnitten 5.4 und 5.5 Die Folge der q,,A hat den gleichen 



Informadonsgehalt wie die interpolierende Kurve 7, aus |Abschnitt 5.6. 1[ da diese 
durch die Punkte und die Anfangsbedingungen eindeutig bestimmt ist. 

Toleranzangaben cjj^. lassen sich im einfachsten Ansatz durch den räumlichen 
Freiraum an den Konfigurationen q,,fc beschreiben. Dieser kann wie folgt definiert 
werden: 



^coop 



min {irf2(ni(q,(*,)),i^.(q.(*^)))} (5.84a) 
:ff:=, min {^2(fii(q^(^0), (q-'^'(*i^), ^)^))} (5.84b) 



■^Fehler in der Unifeldrepräsentation, verursacht durch Sensorfehler, fehlerhaftes Kartenmaterial, 
Fehlinterpretationen der Wahmehmungsdaten oder sonstige falsche Annahmen können natürlich trotz- 
dem zu einem ungültigen Bewegungsplan führen. Solche Fehler werden aber nicht vom Planungsalgo- 
rithmus verursacht, sondern müssen durch geeignete Maßnahmen in den Wahrnehmungskomponenten 
verhindert bzw. erkannt werden. 
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min{£;7,£^^^', syi'} (5.84c) 



Darin bc/eichnct d^iV.Al') den minimalen euklidischen Abstand zweier Polygo- 
ne, ili{q,{t)) die polygonale Repräsentation der Geometrie des /-ten Fahrzeugs 
zum Zeitpunkt /. i2'j^^'(q'j''^'(f )• 0 die entsprechende Repräsentanon des j-ten der 
A'obst Hindernisse und den Freiraum zwischen <?,(q, (//.)) und dem Straßen- 
rand, der ähnlich berechnet werden kann wie (71']''^ aus ( 5.72| , (5.731. Der Frei- 



raum zwischen zwei kooperativen Fahrzeugen wird jedem Fahrzeug zur Hälfte 
zugeschlagen. Alternativ könnte auch eine Berechnung der Toleranz aetrennt nach 
Richtungen, z. B. longitudinal und lateral, durchgeführt werden. 

Die Folge (q;.A . f A' = (J. . . . . 7\ stellt eine kompakte Repräsentation des Be- 
wegungsplans dar, die über Funkkommunikation ausgetauscht werden und dem 
/-ten Fahrzeug als Grundlage für die Fcinplanung dienen kann. 



5.7 Zusammenfassung 



Anders als in vielen Robotikanwendungen oder im Luftverkehr wird der Freiraum 
im Straßenverkehr durch den Straßenverlaiif und das enge Passieren anderer Fahr- 
zeuge stark eingeschränkt, sodass nur vergleichsweise wenige Handlimgssequen- 
zen überhaupt einen zulässigen Plan darstellen. Deshalb bestehen bei der Planung 
kooperativer Fahrmanöver besondere Anforderungen an Planungsalgorithmen. Ei- 
nerseits ist es schwierig, unter den vielen möglichen Handlungsscquenzen eine der 
wenigen zulässigen zu linden. Andererseits kann der Suchraum durch eine geeig- 
nete Berücksichtigung der verschiedenen Einschränkungen erheblich verkleinert 
werden. Zusätzlich müssen die Algorithmen die Grenzen der Fahrdynamik beach- 
ten. 

In diesem Kapitel wurden drei Algorithmen beschrieben, die unter Verzicht auf 
Fntkopplungsannahmen einen möglichst großen kooperativen Ilandlungsspicl- 
raum ausschöpfen. Dennoch kann die spezielle Struktur eines gemeinsamen Kon- 
tigurationsraums, der aus mehreren Einzelfahrzeugkonhgurationsräumen entsteht, 
zur Aufwandsreduktion beitragen. Beispielsweise nutzt das Baumsuchverfahren 
diese Struktur zur Vorberechnung von unteren Schranken in den Einzelfahrzeug- 
und Zwei-Fahrzeug-Bäumen. Diese Schranken bewerten den Verlust im weiteren 
Verlauf der Bewegung, der z. B. infolge von Kollisionen entsteht. Ein vergleichba- 
rer Ansatz ist dem Verfasser aus der Literatur nicht bekannt. Bei der gitterbasierten 
Bahnplanung werden untere Schranken eingesetzt, die den Abstand bis zum Ziel- 



punkt abschätzen (siehe Abschnitt 2.3.3 i. Dieses Prinzip ist hier nicht anwendbar. 



da für die kooperative Kollisionsvermeidung kein fester Zielpunkt vorgegebenen 
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wird. Interessante Parallelen ergeben sich zur RRT-Planung, bei der zufällig ge- 
wählte Zustände zu einem Baum verknüpft werden (vgl. Abschnitt 2.3.2| . Die in 



Abschnitt 5.3.2.2 beschriebenen extremen Manöver der Fahrzeuge haben vergli- 
chen mit zufälligen Manövern den Vorteil, dass der Handlungsspiclraum zur Un- 
fallvermcidung besser ausgeschöpft werden kann. Ferner ist anzunehmen, dass 
auch eine RRT-Planung im gemeinsamen Konfigurationsraum erheblich von den 
hier vorgeschlagenen Techniken der Wiederverwendung und Vorberechnung pro- 
fitieren kann. 

Der zweite in der vorliegenden Arbeit untersuchte Algorithmus basiert auf ge- 
mischt-ganzzahligcr linearer Programmierung. Dieses Verfahren wird bereits in 
der Literatur zur kooperativen Bewcgungsplanung beschrieben. Für die hier be- 
trachtete Anwendung wurden wesentliche Modifikationen und Erweiterungen vor- 
genommen, insbesondere eine genauere Geometriebeschreibung und die Model- 
lierung der Straßenfläche. 

Das dritte Verfahren ist die Methode der elastischen Bänder, die aus der Literatur 



zur Einzelfahrzeugplanung bekannt ist. Sie wurde in Abschnitt 5.5 dieser Arbeit 
auf die kooperative Bewcgungsplanung erweitert. 

Eine vergleichende Bewertung dieser drei Algorithmen, die auf grundlegend ver- 
schiedenen Prinzipien basieren, folgt in [Kapitel 6.4| 
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Kapitel 6 



Ergebnisse 



In diesem Kapitel werden die Rrgebnisse vorgestellt und bewertet, die bei der 
Simulation des Konzepts zur Kooperation kognitiver Automobile und der vorge- 
schlagenen Algorithmen erzielt wurden. Zunächst wird kurz auf den verwende- 
ten Verkehrssimulator und die Implementierung der Systemkomponenten einge- 
gangen. Anschliel3end werden in [Abschnitt 6.2 die Ergebnisse der Gruppenbil- 



dunii dargestellt und evaluiert. Abschnitt 6.3 beschreibt Untersuchungen über den 



Einfluss der Vorbercchnunu unterer Schranken und weiterer Parameter im Baum- 



suchalgorithmus zur kooperativen Bewegungsplanung. In Abschnitt 6.4 folgt der 



Vergleich der verschiedenen Algorithmen zur kooperativen Bewegungsplanung 
hinsichtlich ihres Rechenaufwands und ihrer Erfolgsrate bei der Kollisionsvermei- 
dunii in zahlreichen simulierten Szenarien. Verschiedene Varianten und Erweite- 



rungen der Bewegungsplanung werden in Abschnitt 6.5 vorgestellt, darunter die 



Minimierung der Kollisionsschwere. Schließlich wird in Abschnitt 6.6 das Zu- 
sammenwirken der Komponenten (Iruppenbildung, Siluationsbewertung und Be- 
wegungsplanung zur kooperativen Kollisionsvermeidung demonstriert. 



6.1 Simulationssystem 

Als Grundlage für die Bewertung der in dieser Arbeit vorgestellten Verfahren dient 
der in llVacek()7|| beschriebene Verkehrssimulator. Ein Straßennetz entsprechend 



der Modellierung aus [Abschnitt 3.3.? wird dem Simulator als statische Szenen- 



beschreibung vorgegeben. Die dynamische Szene enthält die Eigenschaften und 
Anfangszustände der simulierten Fahrzeuge. Die Fahrtroute kann in Form einer 
Liste von aufeinanderfolgenden Fahrspuren spezifiziert werden. 

Der Simulator arbeitet zeitdiskret mit einem wählbaren Abtastintcrvall. Das 
Fahrzeugfolgeverhalten wird in Anlehnung an das Wiedemann-Modell simuliert 
llWiedemann74l . Der Ablauf von Spurwechseln und Überholvorgängen orientiert 
sich an den Ergebnissen von IIFritzsche99l . Der Simulator unterstützt sowohl Auto- 
bahnen und Landstraßen als auch Stadtverkehr. An Kreuzuntien beachten die Fahr- 
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Abbildung 6.1: Softwarearchiteklur zur Simulation der Kooperation. 



zeuge Vorfahrts- und Stoppschilder. Wenn keine Schilder vorhanden sind, wird die 
Rcchts-vor-Links-Regel angewendet. 

Die Fliizcnschaftcn und Zustände der simulierten Fahrzeuge sind zur Laufzeit 
für externe Prozesse zugänglich. Als Schnittstelle dient die Realzeitdatenbasis 
(RTDB), die auf gemeinsamem Speicher basiert ICloeblOOll . Um die Verhaltens- 
entscheidung kognitiver Fahrzeuge simulieren zu können, werden die von externen 
Prozessen berechneten Zustände über die RTDB in den Simulator zurückgeschrie- 
ben. 

Für die Simulation der Kooperation werden externe Softwareprozesse für mehre- 
re kognitive Fahrzeuge an den Simulator angebunden ( |Abb. 6.1) . Diese Prozesse 



werden von einem zusätzlichen Ablaufstcuerungsmodul gestartet, das über eine 
XML-Datei konfiguriert werden kann. Außerdem werden Synchronisationsobjek- 
le in der RTDB angelegt, um einen zeitsynchronen Ablauf aller Prozesse gewähr- 
leisten zu können. Dadurch muss die simulierte Zeit nicht mit der realen Zeit über- 
einstimmen, sodass die Komponenten für die Simulation nicht echtzeitfähig sein 
müssen. 



Copyt 
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Die Implementierung der Kooperation wurde auf drei eigenständige Prozesse auf- 
geteilt, die nebenläufig ausgeführt werden können. Die Gruppenbildung wurde in 
Java implementiert, die Bewegungsplanung in C++. Die Situationserkennung ist 
zum Teil in MATLAB realisiert und wird über eine Java-Schnittstcllc aufgerufen 

I Bat/OOl . 

Für die verschiedenen Bewegungsplanungsalgorithmen gibt es eine einheitliche 
Schnittstelle in Form einer abstrakten Obcrklassc. Der zu verwendende Algorith- 
mus wird in der Konfigurationsdatei ausgewählt, die auch die Parameter für Be- 
wegungsplanung und Gruppenbildung festlegt. Es wurde auf eine effiziente Imple- 
mentierung geachtet, ohne jedoch spezielle Laufzeitoptimierungen durchzuführen. 
Auf eine Parallelisierung der Algorithmen wurde verzichtet. 

Die nachfolgend beschriebenen Simulationsergebnisse wurden auf einem Stan- 
dard-Desktop-PC erzielt, der mit einem 1.8-G Hz-Zwei-Kern-Prozessor und 1 GB 
Hauptspeicher ausgestattet ist. Als Betriebssystem wird Linux verwendet. Die Si- 
tuationserkennung wurde auf einem separaten Rechner ausgeführt und über die 
Java-RMI-Schnittstelle angesteuert BSchncbclOOll . 

6.2 Kooperative Gruppen 

Dieser Abschnitt beschreibt die Simulationsergebnisse zur Bildung kooperativer 
Gruppen. Zunächst werden einige Beispielszenarien vorgestellt und die Optimie- 
rung der Parameter in der Bewertungsfunktion s beschrieben. In [Abschnitt 6.2.4 
wird auf die Ergebnisse des Partitionierungsalgorithmus eingegangen. Anschlie- 
ßend wird die Robustheit des Verhandlungsprotokolls untersucht. Schließlich 
wird eine Auswertung von simulierten Unfällen vorgenommen, um eine Aussa- 
ge darüber zu erhalten, in welchem Anteil der Unfälle die beteiligten Fahrzeuge 
derselben kooperativen Gruppe angehören. 

6.2.1 Beispielszenarien 

Zur Bewertung der Gruppenbildung wurden verschiedene Simulationsszenen er- 
stellt, die Stadt-, Überland- und Autobahnverkehr abdecken: 

• Weststadt: Nachbildung eines Ausschnitts aus dem Straßennetz der Karlsru- 
her Weststadt, der sowohl mehrspurige Hauptverkehrsstraßen als auch enge 
Nebenstraßen umfasst. 

• Landstraße: eine zweispurige Landstraße, auf der das Überholen bei Gegen- 
verkehr .simuliert wird. 
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Autobahnauffahrt: ein Autobahnabschnitt mit einer Halbanschlussstelie und 
den zugehörigen Kreuzungen mit einer zweispurigen Straße. 

Ettlingen: eine ähnliche Szene mit einer Vollanschlussstelle, die in Anleh- 
nung an die Ausfahrt Ettlingen der A5 modelliert wurde. 

Autobahn: eine vierspurige Autobahn zur Simulation von Überholmanövern 
und von Einfädclvorgängcn an einer Anschlussstcllc. 



Die Abbildungen [6.2| bis |6.4| zeigen berechnete Gruppeneinleilungen in einigen 
dieser Szenen mit bis zu 60 kooperativen Fahrzeugen. Zur Visualisierung wer- 
den alle Fahrzeuge einer kooperativen Gruppe in der gleichen Farbe dargestellt. In 



Abb. 6.2( a ) bilden sich getrennte Gruppen in jeder Fahrtrichtung der Autobahn und 
auf der Uberführung. Das auffahrende Fahrzeug schließt sich der Gruppe auf der 
Autobahn an, da die Auffahrt einen gemeinsamen Treffpunkt darstellt. Im weite- 
ren Verlauf verlassen zwei Fahrzeuge die Autobahn, und die weiß gekennzeichnete 
Gruppe spaltet sich auf. Die beiden ausfahrenden Fahrzeuge schließen sich der rot 
markierten Gruppe an, die an der Kreuzung einen gemeinsamen Treffpunkt hat. 

Abbildung 6.4|zeigt die Gruppeneinteilung in einem Stau auf der Autobahn. Bei 



den im Stau stehenden Fahrzeugen sind die Gruppengrenzen letzdich willkürlich. 
Die kooperative Unfallvermeidung dürfte aber bei stehenden oder sehr langsam 
fahrenden Fahrzeugen ohnehin kaum Anwendungen haben. Wichtiger ist es, Auf- 
fahrunfälle am Stauende verhindern zu können. Einzelne Fahrzeuge, die sich ei- 
nem Stauende nähern, bilden i.d. R. eine gemeinsame Gruppe mit den hintersten 
stehenden Fahrzeugen. Dies wird u. a. durch den Term »v der Bewertungsfunkdon 
aus ( |4.4| erreicht, der die Relativbewegungen der Fahrzeuge berücksichtigt. 



6.2.2 Vergleichskriterium 

Zur Bewertung der Gruppenbildung wird die für ein Szenario berechnete Grup- 
penzuordnung Gl mit einer anderen Gruppenzuordnung verglichen. Diese Grup- 
penzuordnung G-y kann entweder als Grundwahrheit manuell vorgegeben werden 
oder unter idealisierten Bedingungen berechnet werden. Formal lässt sich das ver- 
wendete Gütemaß ./ mit Hilfe des Kronecker-Symbols 8 wie folgt ausdrücken: 

T N 

J{G,M2) = ^ ■ ^ • I] Z 8{G,{ci, k), G2(c„ k)) ■ 100 % (6.1) 

Dabei bezeichnet (7](c,, A") die Gruppe, in die Fahrzeug c/ zum diskreten Zeit- 
schritt k eingeteilt ist, und G^ici, k) die cnt.sprcchende Gruppeneinteilung in der 



Cot ■ -HK-..-! ... - ',-.rial 
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(a) kooperative Gruppen zum Simulationszeitpunkl t = 9.5 s 




OS 



•I 

(b) kooperative Gruppen zum Simulationszeitpunkt / IG s 

Abbildung 6.2: Simulation der Bildung kooperativer Gruppen in der Szene Auto- 
bahnauffahrt. 
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_ ir'LT°i~p ^* ^* ^* 



Abbildung 6.4: Gruppcnbiidung im Stau. 



Vergleichsgrundlage. Die Gesamtzahl der simulierten Fahrzeuge wird mit A be- 
zeichnet, die Anzahl der diskreten Zeitschritte mit 7'. 

Um den Term S{(i\{ci,k).G2{ci,^)) berechnen zu können, muss zunächst eine 
Abbildung zwischen den Gruppen aus Ci\ und G'o zum Zeitschritt A- gefunden 
werden. Beispielsweise erhält man für die (uuppen Qi — {c\,C2.Ci] und Q\ — 
{c4, C5} aus Gl sowie Q2 — (ci , co } und €,'2 — {<:"3» ff, } aus G'2 die Zuordnungen 
Gl ^ G\ und Go G^, sodass lediglich das Fahrzeug C3 als falsch eingeteilt 
gewertet wird. 



6.2.3 Paranieteroptimierung 



Die Bewertungsfunktion s{Q) aus Kapitel 4.3 enthält einige Gewichtungsfaktoren 



und sonstige Parameter. Da nicht unmittelbar klar ist, nach welchen Kriterien die- 
se Parameter gewählt werden sollen, wird hier ein Optimierungsansatz verwendet: 
Ausgehend von einer initial berechneten Gruppeneinteilung wird ein Szenario an 
einzelnen Zeitpunkten manuell annotiert, um die Gruppenbildung im Hinblick auf 
die Chancen zur KoUisionsvermcidung gezielt zu verbessern. Der Parametervek- 
tor A wird nun so optimiert, dass die Abweichung ./(<"ja, C^annot) zwischen der 
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mit dem Parametersatz A berechneten Gruppeneinteilung Gx und der manuell an- 
notierten Einteilung Ginn^^i minimal wird. Zur Optimierung wird ein evolutionärer 
Algorithmus verwendet, der in lFrese07al beschrieben ist. Durch die Paramelerop- 
timierung konnte die Abweichung von der manuell erstellten Grundwahrheit um 
mehr als 75 % reduziert werden. 



6.2.4 Partitionierungsalgorithmus 

Der Any-Timc-Algorithmus zur approximativen Berechnung der optimalen Parti- 
tion ( Abschnitt 4.4. 3| wird an einem Bcispiclszcnario mit 17 Fahrzeugen cvaluicrt. 



Für dieses Beispiel aus der Szene Autobahnauffahrt können die global optima- 
len Pariilionen gemäß ( |4.9| mit einer Branch-and-Bound-Suche exakt berechnet 
und als Grundwahrheit für das Gütemaß .7 verwendet werden. Die Parlitionie- 
rung mit dem Any-Timc-Algorithmus unter Verwendung der Nachbarschaftsbe- 
dingung ( 4. 1 0} liefert bei 50 ms zugelassener Rechenzeit eine Übereinstimmung 



von .7 99.12%, Für eine Rechenzeil von 1 s erhöht sich die Übereinstimmung 
auf 99.85%, bei iüü s ist die Einteilung identisch mit der Grundwahrheit. Zum 
Vergleich sei noch das Ergebnis des gierigen Partitionierungsalgorithmus angege- 
ben: Er erreicht eine LIbcrcinstimmung von 87.65%. Szenarien mit einer gri)ßeren 
Anzahl kooperativer Fahrzeuge konnten nicht evaluiert werden, da die Ermittlung 
des globalen Optimums aufgrund des Rechenaufwands nicht möglich war. 

Eine Gruppenbildung mit einer Aktualisierungsfrequenz von lü Hz ist bei einem 
Zeitlimit von 50 ms für den Partitionierungsalgorithmus in Echlzeit möglich, da 
der gesamte sonstige Rechenaufwand, in den insbesondere die Abstandsberech- 
nung eingeht, bei der momentanen Implementierung ebenfalls im Bereich von 
50 ms liegt. 



6.2.5 Verhandlungsprotokoll 

Bezüglich des Verhandlungsprotokolls ist vor allem die Robustheit gegenüber La- 
tenzen und Paketverlusten in der Funkkommunikation von hiteresse. In der Si- 
mulation werden die Nachrichten des Verhandlungsprotokolls mit Paketen der 
Kommunikationsebene gleichgesetzt, d. h. jede Nachricht besteht aus genau einem 
Paket. Diese Annahme ist angesichts des vergleichsweise geringen Umfangs der 
Nachrichten gerechtfertigt. Das einfachste Modell für Pakctvcrlustc besteht darin, 
dass eine Nachricht mit einer Wahrscheinlichkeit p\> verloren geht, unabhängig 
vom Verlust anderer Nachrichten. Etwas realistischer ist die Annahme, dass die 
Verbindung zwischen einem bestimmten Sender-Empfänger-Paar für einen län- 
geren Zeitraum gestört ist, sodass mehrere aufeinanderfolgende Pakete verloren 
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p\' 


0.0 


0.2 


0.5 


0.1 


0.5 


Pv 


ü.ü 


0.2 


0.5 


0.9 


0.9 




9G.3% 


93.7% 


90.3% 


81.3% 


64.9%, 



Tabelle 6.1: Hinfliiss von Pakelverluslen auf die Clruppeneinleilung (aus 
IIFrese07ai ). 



gehen. Dies kann dadurch modelHert werden, dass eine Nachricht mit einer hö- 
heren Wahrscheinlichkeit ;jp > /?v verloren geht, wenn hereits die vorhergehende 
Nachricht auf der gleichen Sender-Empfänger- Verbindung nicht angekommen ist. 

Der verteilte Gruppenbildungsalgorithmus wurde für verschiedene Werte von 7>v 
und pp simuliert. Die Bewertung erfolgt durch Vergleich des Ergebnisses Gp^. p^, 
mit der Gruppeneinteilung C'z, die mit dem zentral ablaufenden Algorithmus un- 
ter sonst gleichen Bedingungen berechnet wurde. In Tabelle 6.1 ist jeweils die 
relative Übereinstimmung unter dem Gütemaß J(G;,^,y,p, G'/) aus Gleichung ( |6. 1 ) 
angegeben. 

Die Verschlechterung selbst bei ungestörter Kommunikation kommt durch den ge- 
ringfügig verzi^gcrten Gruppcnwcchscl infolge der Latenzzeiten für den Nachrich- 
tenaustausch zustande. Mit steigender Fchlcrwahrschcinlichkcit nehmen auch die- 
se Latenzen immer weiter zu. Dennoch bilden sich bei mäßig gestörter Kommu- 
nikation die gleichen Gruppen wie im ungestörten Fall, wenn auch entsprechend 
verzögert. Bei stark gestörter Kommunikation kommt es gelegentlich zur Bildung 
anderer Gruppen, die aber häufig nur unwesentlich schlechter bewertet sind und ei- 
ne gute Approximation an die optimale Einteilung darstellen. Lediglich im letzten 
untersuchten Fall (pv = 0.5, pp = 0.9) ist die Kommunikationsqualität zu schlecht 
für eine sinnvolle Gruppenbildung. 

Die Auswahl des Gruppenkoordinators nach dem Kriterium l 4. 13| reduzierte die 
Anzahl der Koordinatorwechsel im Vergleich mit einer willkürlichen Auswahl auf 
Grundlaiie der IdentiHkationsnummcrn um etwa 15%. 



6.2.6 Auswertung von simulierten Unfällen 



Mit der verteilten K(H)pcration wird das Ziel verfolgt, durch kooperative Fahrma- 
növer zu einer verbesserten Verkehrssicherheit beizutragen. Für das Systemkon- 
zept aus [Kapitel 3|ist es von entscheidender Bedeutung, dass die an einer Gefah- 



rensituation beteiligten Fahrzeuge in eine gemeinsame kooperative Gruppe einge- 
teilt werden, da nur in diesem Fall eine kooperative LJnfallvermeidung möglich ist. 



Um zu untersuchen, inwieweit die Gruppcnbildungskritcrien aus Kapitel 4 dieses 
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Abbildung 6.5: Gruppcn/.ugeh(>rigkeit der Unfallbeteiligten im siiiuilicrten Stadt-, 
Überhmd- und Auti>bahnverkehr. 



Ziel erreichen, wird die Gruppenbildung in Szenarien mit provozierten Unfällen 
simuliert. Anschlie[3end wird ausgewertet, ob die am Unfall beteiligten Fahrzeuge 
derselben kooperativen Gruppe angehören. 

Die simulierten Szenarien decken den Stadt-, Überland- und Autobahnverkehr 
ab. Der Verkehrssimulator wird so parametriert, dass Kollisionen zwischen den 
Fahrzeugen provoziert werden. Auf der Autobahn entstehen vorwiegend Unfäl- 
le durch Spurwechselmanöver und Auffahrun fälle am Stauende. Im Landslraßen- 
szenario treten beim Überholen Kollisionen mit dem Gegenverkehr auf. Im Stadt- 
verkehr werden die Missachtung der Vorfahrt an Kreuzungen sowie ebenfalls 
Spurwechsel- und Auffahrunfällc simuliert. Da die simulierten Unfälle keine re- 
präsentative Stichprobe des tatsächlichen Unfallgeschehens darstellen, können die 
Ergebnisse nur ein erstes Indiz über den Frfolg der Gruppenbildung liefern. 



Die Auswertung ist in Abb. 6.5 dargestellt. Die Zielsetzung, dass die an einem Un- 
fall beteiligten Fahrzeuge derselben Gruppe angehören, wird weitgehend erreicht: 
In allen drei Szenarien sind nur an ca. 5% der Kollisionen Fahrzeuge beteiligt, die 
in verschiedene kooperative Gruppen eingeteilt sind. Dieses Ergebnis belegt, dass 



mit der Vorgehensweise aus Kapitel 4 in den unterschiedlichen Verkehrsszenarien 



sinnvolle kooperative Gruppen gebildet werden können. 

Allerdings ist auch zu erkennen, dass sich die Fahrzeuge häufig erst kurz vor 
dem Unfall einer gemeinsamen Gruppe anschließen, sodass es fiir einen kollisi- 
onsvermeidenden Eingriff möglicherweise bereits zu spät ist. Die Ursache dafür 
ist meistens, dass der Abstand zu anderen potenziellen Ktx)perationspartnern bis 
kurz vor der Kollision geringer ist als zum späteren Unfallgegner. Besonders aus- 
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Abbildung 6.6: Typisches Szenario, in dem der Beitritt der späteren l Infallbetei- 
liglen c\ und co zu einer gemeinsamen kooperativen Gruppe zu spät erfolgt, weil 
zahlreiche weitere mögliche Kooperationspartner vorhanden sind. 



geprägt ist dieser Ilft'ckt auf der Landstraße, wo in kurzer Zeit zahlreiche Fahr- 
zeuge im Cicgenvcrkehr passiert werden, die alle als Kooperationspartner in Frage 
kommen ( Abb. 6.6) . Da die Möglichkeit eines Unfalls mit diesen anderen Fahr- 



zeugen ebenfalls in Betracht gezogen werden muss, sind die Ergebnisse weniger 
als Folge unzureichender Gruppenbildungskritcrien, sondern vielmehr als unver- 
meidliche Auswirkung dichten Verkehrs zu bewerten. Die Kriterien können im 
besten Fall bewirken, dass ein Fahrzeug eine gemeinsame Gruppe mit denjeni- 
gen Fahrzeugen bildet, die innerhalb eines kurzen Zeithorizonis als Unfallgegner 
in Frage kommen. Falls dies mehr Fahrzeuge sind als die zugelassene Gruppen- 
gröBc erlaubt, beschränkt sich die Gruppe auf die nächsten Nachbarn im Sinne des 
Abstandsbegriffs. Dann kann es vorkommen, dass die Unfallbcteiligtcn zu spät 
derselben Gruppe beitreten. In Situationen mit geringem Verkehrsaut"kommen er- 
folgt die Gruppenbildung überwiegend rechtzeitig. Eine nennenswerte Verbesse- 
rung im dichten Verkehr kann vermutlich nicht ohne eine deutliche Vergrößerung 
der Gruppen erreicht werden. Eine solche Maßnahme ist aber aus Gründen des 
Kommunikations- und Rechenaufwands problematisch. 

Nimmt man an, dass ein Eingriff zwei Sekunden vor dem Ihifall im Durchschnitt 
ausreichend ist, können insgesamt gesehen etwa zwei Drittel der simulierten Un- 
fälle mit dem Ansatz der verteilten Kooperation adressiert werden. In den übrigen 
Fällen müsste die Unfallvermeidung wie im heutigen Straßenverkehr ausschließ- 
lich durch geeignete Entscheidungen der Einzelfahrzeuge erfolgen. 



6.3 Experimentelle Analyse des 

Baumsuchverfahrens zur kooperativen 
Bewegungsplanung 

In diesem Abschnitt wird der Einfluss verschiedener Parameter auf die Laufzeit 



des Baumsuchplaners aus Kapitel 5.3 untersucht. Darunter sind die Suchstrategie 
und das Ausmaß der Vorberechnung. Des Weiteren wird gezeigt, wie das Verfahren 
unter Verzicht auf bestimmte Anforderungen an die Lösung beschleunigt werden 
kann. 
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6.3.1 Einfluss der Vorberechiiung und Zwischenspeicherung 

Der Einfluss der Vorberechnungs- und Zwischenspeicherungstiefen Psv, Pco\h 
Ss\, Scoi\ wird anhand eines Kreuzungsszenarios mit drei bzw. vier Fahrzeugen 
gezeigt. Eingesetzt wird der Baumsuchalgorithmus zur Minimicrung der Anzahl 



Kollisionen mit T = 4 EnLschcidungszcitpunkten. In Abb. 6.7 ist für verschiede- 
ne Parameterkombinationen jeweils die durchschnittliche Rechenzeit über die Pla- 
nungsprobleme des Szenarios und das Maximum der Rechenzeiten dargestellt. Da- 
bei werden die A*-Suche und die Branch-and-Bound-Strategie (BB) miteinander 
verglichen. Der Vorberechnungsaufwand ist ebenfalls aufgetragen. 

Im schwierigeren Szenario mit M = 4 kooperierenden Fahrzeugen führt die A*- 
Suche ohne Vorberechnung zu einem Speicherüberlauf, sodass für diese Parame- 
terkonfigurationen keine Rechenzeit angegeben werden kann. Ebenfalls verzichtet 
wird auf die Messung der BB-Strategie ohne Vorberechnung und Zwi.schenspei- 
cherung, da hier bereits für einfache Planungsaufgaben Rechenzeiten von mehre- 
ren Stunden zu beobachten sind. Mit Vorberechnung der unteren Schranken aus 
der Einzelfahrzeuginformation müssen erheblich weniger Knoten besucht werden, 
sodass der Baumsuchalgorithmus insgesamt weniger als eine Sekunde benötigt. 
Der Aufwand zur Vorberechnung der Kollisionsinformation übersteigt allerdings 
die Einsparungen durch die verbesserten unteren Schranken. 

Die A*-Suchc erreicht im Szenario mit M — 3 Fahrzeugen die besten Ergebnis.se 
mit 5sv = 4, Fsv = 3 und S^ow = /'coli = 0- Bei M = 4 Fahrzeugen lohnt sich zu- 
sätzlich die Zwischenspeicherung der Kollisionsinformation in der Konfiguration 
5sv = Psw = 4, 5coii = 3, Pcoii = 0. Die BB-Strategie erreicht die geringste durch- 
schnittliche Laufzeit in beiden Fällen mit Ssw — Psv — Sco\i = 4 und Pcoii = 0» ist 
also stärker auf die Vorberechnung und Zwischenspeicherung angewiesen als die 
A* -Strategie. 

Die dargestellten Ergebnisse zeigen, dass es möglich ist, den größten Teil des Re- 
chenaufwands in die Vorverarbeitungsphase zu verlagern. Damit kann die Varianz 
der Laufzeit über verschiedene Planungsproblcmc deutlich reduziert werden, da 
der Vorberechnungsaufwand nahezu konstant bleibt. Dies ist eine wichtige Beob- 
achtung im Hinblick auf die Echtzeitfähigkeit des Baumsuchalgorithmus. 



6.3.2 Einfluss der Handlungsmenge und des 
Verlustfunktionais 

Beim hier vorgeschlagenen Algorithmus bilden die Handlungsaltemativen die 
Grundlage für den Aufbau der Baumstruktur, nicht die möglichen Konfigurationen 
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Abbildung 6.7: Einfluss der Vorbcrcchnungsparamcter auf die Laufzeit des Baum- 
suchverfahrens mit T — 4 Entscheidungszeitpunkten. Die Vorberechnung nimmt 
von links nach rechts zu. Der vordere Balken entspricht jeweils der mittleren Re- 
chenzeit über den Planungsproblemen des Szenarios Kreuzung 1 in logarithmi- 
scher Darstellung, der hintere Balken der maximalen Rechenzeit. Der Vorberech- 
nungsaufwand ist im unteren Teil der Balken wiedergegeben. Parametersätze, mit 
denen die Suche nicht in akzeptabler Z^it terminiert, sind durch ein Kreuz gekenn- 
zeichnet. 
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oder Zustande wie bei den Graphen aus gitterbasierten Planungsverfahren (siehe 
Kapitel 23) . Daher kann es passieren, dass mehrere Knoten des Baums den iden- 



tischen Zustand beschreiben. Bei der geringen Anzahl Entscheidungszeitpunkle, 
mit der eine cchtzcittahigc kooperative Planung möglich ist, sind solche mehrfach 
im Baum auftretenden Zustände aber sehr selten. Auf Maßnahmen zur Erkennuna 
und Vermeidung doppelter Zustände wird daher verzichtet, da sie mit zusätzlichem 
Verwaltungsaufwand für geeignete Dalenstrukturen verbunden sind und daher den 
Gesamtaufwand vermutlich nicht reduzieren können, im Fall einer feineren Zeil- 
diskretisierung, wie sie in Abschnitt 6.4. 1 .5 beim Einsatz des Baumsuchverfahrens 
als Einzelfahrzeugplaner im Rahmen der prioritätsbasierten Planung verwendet 
wird, spielt das Problem mehrfach auftretender Zustände dagegen eine deutlich 
größere Rolle. Dies ist ein wesentlicher Grund, wiu-um diese hnplemenlierung der 
prioritätsbasierten Planung suboplimal hinsichtlich des Rechenaufwands ist. 

Ein weiterer Fall, in dem identische Zustände Probleme verursachen können, tritt 
auf, wenn ein Fahrzeug r, im Bcvvcgungsplan bis zum Stillstand abbremst. Dann 
entsprechen alle Handlungen außer dem Beschleunigen a^*-*^ dem Stehenbleiben 
des Fahrzeugs, führen somit zum gleichen Folgezustand und erhalten die gleiche 
Bewertung durch das Verlustfunktional. Deshalb kann der Baumsuchalgorithmus 
nicht zwi.schcn den Handlungsalternativcn differenzieren und müsstc alle Folge- 
knoten explorieren, was einen sprunghaften Anstieg der Rechenzeit zur Folge hät- 
te. Dieses Problem wird behoben, indem im Fall des Stillstands von Fahrzeug q 
lediglich die Handlungsalternativen a^""'^' und af^ zugelassen werden. 

In ähnlicher Weise können sich auch bestimmte Modifikationen des Verlustfunk- 
tionais auf die Laufzeit der Suche auswirken. Prinzipiell ist ein Verlustfunktio- 
nal günstig, das möglichst stark zwischen den Alternativen diskriminiert. Dadurch 
wird die Suche frühzeitig auf die erfolgversprechenden Teilbäume beschränkt. Er- 
halten hingegen viele Alternativen ähnliche Bewertungen, so muss eine größere 
Anzahl Knoten exploriert werden. Wie in [Abschnitt 6.4.4."^ gezeigt wird, kön- 
nen ähnliche Effekte auch von bestimmten Probleminslanzen verursacht werden. 
Ergebnisse mit einem modifizierten Verlustfunklional werden in den Abschnit- 
ten 6 .5 .3 1 u nd |6 .5 .5 1 vorgestellt. 



6.3.3 Einschränkung auf das Problem der 
Kollisionsvermeidung 



Wie in [Abschnitt 5.3.2.3| erläutert, wird mit dem Verlustfunktional die Anzahl der 
Kollisionen minimiert. Beschränkt man hingegen die Aufgabenstellung auf das 
Finden von Plänen, die frei von Kollisionen sind und alle Fahrzeuge auf der Straße 
halten, kann ein leicht modifizierter Baumsuchalgorithmus eine deutliche Reduk- 
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tion des Rechenaufwands erreichen. Dazu wird ein Schwellwert L,hr für das Ver- 
lustfunktional vorgegeben, unterhalb dessen die Bewertung des gesuchten Plans 
liegen soll. Existiert ein solcher Plan, so wird dieselbe optimale Lösung innerhalb 
von ß gefunden wie vom Baumsuchalgorithmus mit Minimierung der Anzahl Kol- 
lisionen. Andernfalls kann der modifizierte Algorithmus keine Lösung finden und 
gibt eine Fehlermeldung zurück. Wie in [Abb. 574] auf Seite 89 zu sehen ist, kann 
der Schwellwert Z,,hr so gewählt werden, dass alle Pläne ausgeschlossen werden, 
die Kollisionen oder ein Verlassen der Straße beinhalten. Das Verlustfunktional 
muss dazu nicht verändert werden. 

Bei der Branch-and-Bound-Suche kann durch die Einschränkung auf reine Kolli- 
sionsvermcidung das Kriterium ( ]5i.49| /um Ausschluss eines Teilbaums wie folgt 



modifiziert werden: 

L{wot,n) \ /?(n) > miii{L*, L,hr} (6.2) 

Damit wird ein Teilbaum ausgeschlossen, sobald erkannt wird, dass er zu einer 
Kollision oder zu einem Verlassen der Straße führt. Falls eine Kollisionsvermei- 
dung nicht möglich ist, dringt die Suche nie bis zu einem Blatt von B vor. Mit dem 



Kriterium ( |6.2| ( können bereits in der Vorberechnungsphase Teilbäume der und 
Bij ausgeschlossen werden. 

Bei der A*-Suche wird auf das Einfügen eines Knotens n in die Prioritätswarte- 
schlange verzichtet, falls g{n) > Lthr ist für y{n) aus (j53Ü). Stattdessen wird ein 



solcher Knoten sofort verworfen. Falls eine Kollision unvermeidbar ist, läuft die 
Prioritätswarteschlange leer, ohne dass ein Blatt erreicht wird. Dann liefert der 
Algorithmus eine entsprechende Fehlermeldung zurück. 



Diese Variante des Baumsuchverfahrens wird für den Vergleich in Abschnitt 6.4 
verwendet, da sich die anderen untersuchten Algorithmen ebenfalls auf die Kol- 
lisionsvermeidung beschränken. Ahhikluni; 6.8| zeigt die Auswirkung der Modifi- 



kation auf den Rechenaufwand in einem Kreuzungsszenario. Bei der Suche in B 
kann der Rechenaufwand deutlich reduziert werden, da weniger Knoten besucht 
werden. Die Einsparung bei der Vorberechnung ist hingegen eher gering. 



6.3.4 Beschleunigung durch Verzicht auf Optinialität 

Der bisher beschriebene Algorithmus findet die bezüglich des Verlustfunktionais 
optimale Handlungssequenz in B. Auf die Optimalität kann zugunsten eines ge- 
ringeren Rechenaufwands verzichtet werden. Zur suboptimalen Planung kann bei 
der Branch-and-Bound-Suche das Kriterium ( |.'S.49{ ) für den Ausschluss eines Teil- 
baums wie folgt modifiziert werden: 

e^subopt • {L{root^ n) + h{ii)) > L* , esubopt > 1 (6.3) 
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Abbildung 6.8: Beschleunigung des Baumsuchverfahrens durch Abschwächung 
der Problemformulierung: reine Kollisionsvermeidung und suboplimale Planung 
im Szenario Kreuzung 2, AI = 4 mit den Parametern T = 3, Psv = •S'sv = »^coii = 3, 



Fcoii = 2 (Darstellungsweise wie bei Abb. 6.7 erläutert) 



Damit werden auch Teilbäume ausgeschlossen, deren Bewertung höchstens um 
den Faktor Ssubopt besser ist als das bisherige Optimum L*. 

Bei der A*-Suche wird ein ähnlicher Effekt durch die folgende Modifikation der 
Knotenbewertungsfunktion (|53ü} erreicht: 



9subopM •= L{root, n) + ^subopt • , 



^subopl 



> 1 



(6.4) 



Auch hier kann garantiert werden, dass die gefundene Lösung höchstens um den 
Faktor e^subopt schlechter ist als die optimale ILikhachev03l . Der Parameter fsubopt 
kann so gewählt werden, dass stets eine kollisionsfreie kooperative Bewegung zu- 
rückgeliefert wird, sofern eine solche existiert (vgl. [Abb. 5.4 auf Seite 89). An- 
ders als bei der Variante aus dem vorangegangenen Abschnitt wird aber auch dann 
ein Bewegungsplan gefunden, wenn eine Kollision unvermeidbar ist. Im Grenz- 
fall ^subopi = 1 erhält man den ursprünglichen Algorithmus. Die Auswirkung einer 
suboptimalen Planung auf die Rechenzeit ist ebenfalls in Abb. 6.8| dargestellt. 



6.3.5 Vergleich von Branch-and-BouncI- und A*-Suche 

In den vorangegangenen Analysen l )Abb. 6.7| und |6.8^ wurden die Laufzeiten der 
Branch-and-Bound- und der A*-Suche gegenübergestellt. In der Mehrzahl der Fäl- 
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Abbildung 6.9: Visualisierung der generierten Knoten von ß' (vgl. Abb. 5.7 



auf 



Seite 93) in einem Überholszenario mit M — 4, T — 4, i^sv = 4, P^^^y\\ — ü. 



le ist die A*-Suche effizienter, weil sie weniger Knoten besuchen muss, um die op- 
timale Handlungssequenz zu finden. Die Optimalität der A*-Strategie im Hinblick 
auf die Anzahl besuchter Knoten ist auch theoretisch nachgewiesen llDechter85l . 



Für die kooperative Bevvegungsplanung zeigt Abb. 6.9 eine Visualisierung der von 
A* und BB besuchten Knoten von B. Zunächst fällt auf, dass die Suche auf einen 
sehr kleinen Anteil des Baums beschränkt werden kann. Des Weiteren werden 
alle von A* besuchten Knoten auch von BB besucht. Im dargestellten Beispiel 
aus einem Überholszenario mit M = 4 kooperativen Fahrzeugen und T = i Ent- 
scheidungszeitpunkten hat der Baum ß mehr als 10^'' Knoten. Von der A*-Suche 
werden etwa iü' Knoten von ß' in die Prioritälswarleschlange eingefügt. Die BB- 
Strategie evaluiert ca. 10*^ Knoten von B und wählt davon lO'^' zur Weiterverarbei- 
tung aus. Insgesamt benötigen beide Suchstrategien in diesem Beispiel in etwa die 
gleiche Rechenzeit. 



Wie in Abschnitt 6.3.1 gezeigt wurde, ist bei der A*-Strategie i.d. R. weniger 



Vorberechnungsaufwand für eine effiziente Suche erforderlich. Dennoch gibt es 
auch Probleminstanzcn, auf denen BB schneller ist. Häufig sind dies vergleichs- 
weise .schwicriuc Instanzen, in denen eine Kollision unvermeidbar ist. Wenn ci- 
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ne kollisionsfrcic Lösung existiert, kann die A*-Stratcgie die Suche deutlich ef- 
fizienter auf die kollisionsfreien Bereiche von B beschränken. Sobald eine Kol- 
lisionsvermeidung nicht mehr möglich ist, entfällt dieser Vorteil. Die Anzahl be- 
suchter Knoten nimmt deutlich zu, und der Zusatzaufwand für die Vcrwaltunu 
der Prioritätswarteschlange fällt stärker ins Gewicht. Bei manchen Problemen 
bzw. Parametereinslellungen übersteigt der Speicherbedarf der Priori tätswarte- 
schlange sogar den verfügbaren Arbeitsspeicher. In diesen Fällen ist allerdings 
auch die BB-Stralegie deutlich von einer Echlzeilfähigkeit entfernt. Vorteile für 



die BB-Strategie ergeben sich außerdem bei der suboptimalen Planung aus | Ab- 
ischnitt 6.3"? 



6.4 Vergleich der Algorithmen zur 
Bewegungsplanung 

Anhand verschiedener Simulationsszenarien werden vier Algorithmen zur koope- 
rativen Bewegungsplanung miteinander verglichen. Dabei handelt es sich um die 
in Kapitel 5 beschriebenen Algorithmen sowie um einen prioriiätsbasierten Pla- 
ner. Als quantitative Vergleichskriterien dienen der Anteil der erfolgreich gelösten 
Prohlcminstanzcn und der Rechenaufwand. Bevor die Ergebnisse der Auswertung 
beschrieben werden, wird auf die verwendete Paramcti'icrung der Algorithmen und 
auf die simulierten Szenarien eingegangen. 



6.4.1 Parametrierung der Algorithmen 



in diesem Abschnitt wird kurz erläutert, welche Varianten und Parametrierungen 
der Bewegungsplanungsalgorithmen für den Vergleich verwendet werden. Ergeb- 



nisse mit anderen Varianten werden weiter unten in|Ab.schnitt 6.5|dargestcllt. 



6.4.1.1 Planungshorizont 

Zunächst wird an dieser Stelle auf die Wahl des Planungshorizonts /j, eingegangen. 
Ein kooperativer Bewegungsplan zur Abwendung einer Gefahrensituation kann 
offensichtlich nur dann erstellt werden, wenn die Gefahrensituation innerhalb des 
Planungshorizonts auftritt. Der Planungshorizont muss daher mindestens so groß 
gewählt werden, dass er unabhängig von der betrachteten Handlung die Gefah- 
rensituation abdeckt. Zusätzlich sollte eine gewisse Reserve vorhanden sein, um 
zu verhindern, dass ein Fahrzeug beispielsweise unmittelbar nach einer erfolgrei- 
chen Kollisionsvcrmeidung von der Strafte abkommt. 
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Im Fall einer drohenden Kollision mit einem stehenden Hindernis fordert dieses 
Kriterium, dass die betreffenden Fahrzeuge innerhalb des Planungshorizonts zum 
Stillstand kommen können: 

fh > nfax /stop,» , (6.5) 

wobei ^stop.i die Zeit bezeichnet, die Fahrzeug Ci ausgehend vom Zustand xf'"^ 
zum Anhalten benötigt. Der Planungshorizont muss also mit zunehmenden An- 
fangsgeschwindigkeiten vergrößert werden. Anhand dieser Überlegungen wird für 
die untersuchten Szenarien je nach auftretenden Geschwindigkeiten ein Planungs- 
horizont im Bereich von 1.6 s bis 4 s gewählt. Als eine sinnvolle Erweiterungs- 
möglichkeit könnte man die Ergebnisse der aktuellen Situationsbewertung bei der 
Bestimmung des Planungshorizonts miteinbeziehen. 

Bei den meisten Algorithmen gehl der Planungshorizoni linear in den Rechenauf- 
wand ein. Für das Baumsuchverfahren werden dazu bei konstantem T die Ent- 
scheidungszeitpunkte ti- auf das Intervall [ü,/|,] verteilt. Bei den elastischen Bän- 
dern ist es empfehlenswert, den zeitlichen Knotenabstand A< konstant zu lassen 
und einen vergrößerten Planungshorizont durch eine größere Knotenanzahl wider- 
zuspiegeln. 

Ähnlich muss bei der gemischt-ganzzahligen linearen Programmierung vorgegan- 
gen werden, da hier das Abtastintervall nicht beliebig vergrößert werden kann, 
ohne die Kollisionsvermeidung zu beeinträchtigen. Daher müssen zusätzliche Ab- 
tastpunkte eingefügt werden. Somit wird sich in der Regel bei wachsendem Pla- 
nungshorizont auch die Anzahl der binären Variablen vergrößern, sodass der Re- 
chenaufwand überproportional ansteigt. Das MILP- Verfahren kann daher keinen 
linearen Zusammenhang zwischen Planungshorizont und Rechenaufwand garan- 
tieren. 



6.4.1.2 Baumsuche 

Für das Baumsuchverfahren werden die in lAbschnitt 5.3.21 beschriebenen Modelle 
eingesetzt. Die Handlungsmenge jedes Fahrzeugs beinhaltet die folgenden Hand- 
lungen aus |Abschnitt 5.3.2T2] 

Auf die Spurfolgehandlungen «J/'"^-«^*^"''» und o';"^ ''^'"'"^ wird verzichtet, da ihre Hin- 
zunahme die Erfolgsrate des Planers nur unwesentlich steigern kann, aber einen 
deutlichen Anstieg der Rechenzeit zur Folge hat. 
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Folgendes Verlustfunktional wird verwendet: 

Liy) = L-"(7) I L°''^'(7) + L™'"^(7) + L^°"'~'(7) (6.7) 

Die einzelnen Terme wurden in lAbschnitt 5.3.2.3] beschrieben. Verzichtet wird 
auf die Bewertung der Kollisionsschwcrc und auf den Tcrni L^'^'^^'y), der für die 
Kollisionsvermeidung keine Rolle spielt. Ergebnisse mit anderen Varianten des 



Verlustfunktionals werden in Abschniu 6.5 vorgestellt 



Wie in Abschnitt 6.3.3 beschrieben, wird der Algorithmus so modifiziert, dass er 
ausschließlich kollisionsvermeidende Pläne finden kann, dafür aber eine höhere 
Effizienz erreicht. Damit wird ein gerechter Vergleich mit den anderen Algorith- 
men ermöglicht, die sich auf eine reine Kollisionsvermeidung beschränken und 
keine Minimierung der Anzahl Kollisionen oder gar der K(illisionsschwere vor- 
nehmen können. 

Je nach Schwierigkeit des Szenarios und Anzahl beteiligter Fahrzeuge erweist sich 
eine Anzahl der Entscheidungspunkte zwischen 7"= 3 und T" = 6 als praktikabel. 
Die Entscheidungszeitpunkte tk werden nicht äquidistant über den gesamten Pla- 
nungshorizont verteilt, sondern gemäß folgender Heuristik: Die ersten Zeitinter- 
valle [ffc, tk+i] werden relativ kurz gestaltet, um zu Beginn der Gefahrensituation 
möglichst fein manövrieren zu können. Daran werden ein oder zwei längere Zcit- 
intervalle angefügt, die bis zum Ende des Planungshorizonts reichen. In diesem 
Zeitraum genügen häufig konstante Handlungen, um die Unfallgefahr endgültig 
abzuwenden. Beispielsweise kann zunächst ein Ausweich- oder Spurwechselma- 
növer mit einer feineren Zeitdiskretisierung geplant werden, die für ein anschlie- 
ßendes Brems- oder Spurfolgemanöver nicht erforderlich ist. Mit dieser Festle- 
gung der Entscheidungszeitpunkte kann im Vergleich zu einer Gleichverteilung 
der Entscheidungszeitpunkte über den gesamten Planungshorizont ein etwas grö- 
ßerer Anteil der Probleminstanzen erfolgreich gelöst werden. Insgesamt hat die 
genaue Festlegung der Entscheidungszeitpunkte jedoch einen relativ geringen Ein- 
fluss auf den Planungserfolg. Zu beachten ist auch, dass durch die beschriebene 
Vorgehensweise im Allgemeinen der Rechenaufwand gegenüber dem äquidistan- 
ten Fall vergrößert wird. Der Grund dafür ist, dass die Gesamdänge der zu simulie- 
renden Fahrzeughandlungen ansteigt, da in den letzten Zeitintervallen der Hand- 
lungssequenz eine große Anzahl an Alternativen untersucht werden muss. Bei den 
ersten Handlungen eines Plans nutzt hingegen die Baumstruktur gemeinsame An- 
fangsstücke der Handlungssequenz zur Aufwandsreduktion. Der Zeitaufwand für 
die Auswertung des Fahrzeugmodells und des Verlustfunktionals ist näherungs- 
weise proportional zur Gesamtdaucr der simulierten Handlungen. 

Weitere Parameter des Baumsuchverfahrens betreffen die Suchstrategie und die 
Vorberechnung unterer Schranken. Diese Parameter wirken sich nur auf die Lauf- 
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zeit des Verfahrens aus, nicht jedoch auf die Planungsergchnisse. Auf den Einfluss 
dieser Parameter wurde bereits in Abschnill 6.3 eingegangen. Mir den Vergleich 
mit anderen Verfahren wird i.d. R. die A'^^-Suche mit Psv ~ -Ssv ~ S^^.w = T und 
Roll = verwendet. Lcdighch im Szenario Kreuzung 2 für M > l Fahrzeuge wird 
Roll = T gewählt. Bei AI — 2 kooperativen Fahrzeugen kann S^^w = 0 gesetzt wer- 
den, da in diesem Fall keine Redundanzen bei der Berechnung der Kollisionsbe- 
werlung auftreten können. 



6.4.1.3 Gemischt-gunz/ahli^c lineare rrugraminierung 

Die Wahl des Abtastintervalls At ist bei der gemischt-ganzzahligen linearen Pro- 
grammierung kritisch, da die Kollisionsvermeidung über harte Nebenbedingungen 
zu den Abtastzeitpunkten durchgesetzt wird. Das Abtastintervall muss daher ge- 
meinsam mit den räumlichen Abständen djj passend zu den auftretenden Fahr- 
zcusmcschwindiükeiten gewählt werden. Für die untersuchten Szenarien werden 
Abtastintervalle zwischen O.OÜ s und 0.17 s verwendet. Die Anzahl T der Ab- 
lastpunkte ergibt sich zu T= \^]. Sie kann einen erheblichen Einfluss auf die 
Laufzeit des Verfahrens haben, da für jeden Zeitschritt binäre Variable eingeführt 
werden müssen. 

Zur Lösung der gemischt-ganzzahligen linearen Programme wird die frei verfüg- 
bare C-Bibliothek lp_solve 5 . 5 verwendet |ßcrkelaar08l . Die Bibliothek ver- 
füut über zahlreiche einstellbare Parameter, die einen Einfluss auf die Laufzeit 
haben. Insbesondere kann die Lösung von Bewegungsplanungsproblemen durch 
eine Änderung der Heuristik für die Branch-aiid-Bound-Suche des MILP-Lösers 
um Clrößenordnungen beschleunigt werden BFresel lal . Mit weiteren Parameter- 
einstellungcn kann die Laufzeit jeweils um etwa 5-10% verkürzt werden. Die 
Elimination eines beträchtlichen Teils der binären Variablen mit Hilfe der Erreich- 



barkeitsbetrachtunuen aus Abschnitt 5.4.4 kann den Rechenaufwand in manchen 



Szenarien ebenfalls um mehrere (IrößenordnungL-n reduzieren. 

Die Berechnung wird angehalten, sobald die erste zulässige Lösung gefunden ist. 
Diese repräsentiert einen kollisionsfreien kooperativen Bewegungsplan, der für die 
gefundene Belegung der binären Variablen die Zielfunktion bezüglich der kontinu- 
ierlichen Variablen optimiert. Die Berechnung der global optimalen Lösung dauert 
im Durchschnitt etwa doppelt so lange und bringt häufig nur geringe Verbesserun- 
gen. 

Trotz dieser Maßnahmen kann die Lösung des MILPs für manche Planungsauf- 
gaben sehr lange dauern. Für die Durchführung der Evaluation wird daher die 
MILP-Berechnung für eine Planungsaufgabe abgebrochen und als fehlgeschlagen 
bewertet, sobald eine Rechenzeit von einer Stunde überschritten wird. 
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Zur Modellierung der Fahrzeuggeometrie werden die beiden Varianten aus |Ab- 



scliiiiti ■S.4.2| cvaluiert: die Berücksichtigung der Vorgänger- und Nachfolgerposi- 
lionen (bezeichnet als „MILP Vorgänger/Nachfolger") und das rechteckige Geo- 
mctiicmodcll („MILP Rechtecke"). 



6.4.1.4 Elastische Bänder 

Bei den elastischen Bändern ist vor allem die Wahl des zeitlichen Knotenabstands 
At von Bedeutung. Um eine annähernd konstante Ortsauflösung zu erreichen, 
wird At bei größeren Geschwindigkeiten verkleinert. Konkret werden in Abhän- 
gigkeit von der maximalen im Szenario auftretenden Geschwindigkeit Werte zwi- 
schen Ü.l s und 0.2 s gewählt. Die Knotenanzahl T ergibt sich dann aus dem Pla- 
nungshorizont thzu T= l^]. 



6.4.1.5 Prioritätsbasiertc Planung 



Als Vergleichsgrundlage für die drei kooperativen Bewegungsplaner aus Kapi 



[lel 5| wird ein prioritätsbasiertes Planungsverfahren herangezogen. Das Prinzip 
der prioritätsbasierten Bewegungsplanung wurde bereits in [Abschnitt 2.3.4.2 



er- 



läutert. Mathematisch lässt sich eine Prioritätszuordnung für M Fahrzeuge durch 
eine Permutation er e Sj^j beschreiben. Die symmetrische Gruppe aller Per- 
mutationen einer -elementigen Menge hat M\ Elemente. Das Ergebnis der Be- 
wegungsplanung mit der Prioritätszuordnung a wird mit 7^ bezeichnet. Mit Hilfe 
des Verlustfunktionals L können diese Trajektorien bewertet werden und die beste 
Permutation a* ermittelt werden: 

CT* argminL(7^) (6.8) 

Die priori tätsbasierte Planung wird für alle a G durchgeführt. Für die Aus- 
wertung wird einerseits das Ergebnis bei optimaler Prioritätsfestlegung nach ( |6.8^ 
herangezogen. Andererseits wird der durchschnittliche Planungserfolg über alle 
Permutationen berechnet. Dies entspricht dem Erwartungswert bei zufälliger Aus- 
wahl einer Pcimutation aus einer Glcichvcrteilung über Sm. 

In der Literatur wurden verschiedene Ansätze zur Auswahl oder Optimierung der 
Prioritätsreihenfolge vorgeschlagen iHrdmannSVl [vdBLMg().S[ [Bcnncwit/()4l . Spe- 



zielle Regeln für die Prioritätsfestlegung bei der kooperativen Kollisionsvermei- 
dung sind ebenfalls denkbar. In der Simulation hat sich beispielsweise gezeigt, 
dass einem vorausfahrenden Fahrzeug eine höhere Priorität eingeräumt werden 
.sollte als einem in denselben Spur nachfolgenden Fahrzeug. Die Verkehrsregeln 
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könnten ebenfalls als Grundlage herangezogen werden. So könnte etwa dem vor- 
fahrtsberechdgten Fahrzeug an einer Kreuzung die höchste Priorität eingeräumt 
werden. Ferner ist es vorstellbar, auf den Ergebnissen der Situationsbeweriung 
aufzubauen und denjenigen Fahrzeugen höhere Priorität zu gewähren, die sich 
in einer besonders kritischen Situation befinden (vgl. IFindler*),^! ). Verfahren zur 
Prioritätsfestlegung werden in der vorliegenden Arbeit nicht weiter untersucht. Der 
Planungserfolg bei einer solchen Vorgehensweise wird zwischen dem Wert für die 
zufällige und dem Werl für die optimale Prioritätsauswahl liegen. 

Zur Implementierung der prioritätsbasierten Planung ist ein Bewegungsplanungs- 
algorithmus für Einzelfahrzcuge erforderlich, der mit bewegten Hindernissen um- 
gehen kann. Für die hier durchgeführte Evaluation wird auf das Baumsuchver- 
fahren aus Kapitel 53] zurückgegriffen. Da anstatt der kooperativen Handlungs- 



kombinationen < |5li7 1 nur die Handlungsalternativen ,4, eines einzelnen Fahrzeugs 



untersucht werden müssen, ist bei ähnlicher Laufzeit eine deutlich feinere Zeit- 
diskretisierung möglich. Für die hier vorgestellte Auswertung werden T = 8 Ent- 
scheidungsze itpunkte verwende t. Das Verlustfunktional ( j6.7| wird um den Term 



L*'^'''(7) aus [Abschnitt 5.3.2.3| ergänzt. Damit wird erreicht, dass die Fahrzeu- 
ge auf ihrer Fahrspur bleiben, sofern dies kollisionsfrei möglich ist. Ohne diesen 
Term kann es beispielsweise passieren, dass Fahrzeuge mit hoher Priorität in Kur- 
ven auf die Gegenfahrbahn wechseln und die entgegenkommenden Fahrzeuge mit 
niedriger Priorität zu Ausweichmanövern zwingen. Beim kooperativen Baumsuch- 
verfahren tritt dieser Effekt nicht auf, weil die Kollisionsvermeidung stets in die 
Entscheidungsfindung einbezogen wird, während bei der Priorisierung mögliche 
Kollisionen mit Fahrzeugen niedrigerer Priorität zunächst ignoriert werden. Mit 
den Spurfolgchandlungcn a'""^*'''"'' und nj""^'"'^''^ kann bei der prioritätsbasierten 
Planung in den untersuchten Szenarien kein zusätzlicher Gewinn erreicht werden. 
Auf die Vorberechnung von Schranken wird verzichtet, da sie für die Einzelfahr- 
zeugplanung keine Verbesserung bewirken kann. 

Die Implementierung der prioritätsbasierten Planung mit Hilfe des Baumsuchver- 
fahrens ist hinsichtlich des Rechenaufwands keineswegs optimal. Arbeiten zur 
prioritätsbasierten Planung und zur Bewegungsplanung für Einzelfahrzeuge zei- 
gen jedoch, dass für die vorliegende Anwendung eine echtzeitfähige Realisierung 
möglich sein sollte (vdBergO.S Zieglert)9") . Die Optimierung über alle Permuta- 



tionen wurde naiv implementiert. Durch Ausnutzung gemeinsamer Teilstücke von 
Prioritätsreihenfolgen könnte sie noch deutlich beschleunigt werden. Die gemesse- 
nen Rcchcnzciten des prioritätsbasierten Planers werden der Vollständigkeit halber 
dennoch aufgeführt. 
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6.4.2 Simulationsszenarien 



Unter einem Szenario wird im Folgenden ein Straßennetz zusammen mit einer 
Menge von Fahrzeugen und ihren Anfangszusländen verstanden. Die Spezifikation 
des Szenarios bildet die Eingabe für den Verkehrssimulator. Aus einem Szenario 
können zahlreiche Prohleminstanzen erzeugt werden, indem periodisch die aktu- 
ellen Fahrzeugzustände aus dem Simulator ausgelesen und als Anfangszustände 
eines Bewegimgsplanungsproblems angesehen werden. Das geplante kooperative 
Fahrmanöver wird bei den hier beschriebenen Untersuchungen jedoch nicht von 
den simulierten Fahrzeugen ausgeführt. Vielmehr werden die Fahrzeuge ohne ko- 
operativen Eingriffweiterhin vom Simulator gesteuert, um zusätzliche Problemin- 
stanzen zu erhallen. 

Die untersuchten Szenarien erfordern die folgenden kooperativen Fahrmanöver: 



• kooperatives Ausweichen, 

• kooperatives Einfädeln, 

• kooperatives Überholen, 

• kooperative Kreuzungsüberquerung. 



Für jeden der genannten Fälle wurden mehrere Szenarien definiert, die sich durch 
die Anzahl und den Kurvenverlauf der Fahrspuren sowie die Anzahl, die Anfangs- 
positionen und die Geschwindigkeiten der Fahrzeuge unterscheiden. Der Simula- 
tor wurde jeweils so paramctricrt, dass Gefahrensituationen entstehen. Jedoch sind 
nicht alle Probleminstanzen eines Szenarios als Gefahrensituationen einzustufen. 
Zu Beginn des Szenarios ist ein kollisionsvermeidender Eingriff innerhalb des Pla- 
nungshorizonts noch nicht erforderlich. Die Kollisionsgefahr steigt im Verlauf des 
Szenarios immer weiter an, sodass zunächst modcratc und dann immer stärkere 
Brems- oder Ausweichmanöver nötig sind, um Kollisionen zu verhindern. In vie- 
len Fällen ist dann ein abgestimmtes Eingreifen aller kooperativer Fahrzeuge er- 
forderlich (siehe z. B. |Abb. 6.13(b)|[(c)) . Schließlich tritt in den meisten Szenarien 
ein Zustand ein, in dem eine Kollision nicht mehr vermieden werden kann. 



Tabelle 6.2 zeigt eine Übersicht über die verwendeten Szenarien. Die Szenarien 
decken ein breites Spektrum hinsichtlich der Unfalltypen, der Fahrzcugge.schwin- 
digkciten und des Straßenverlaufs ab. Für genauere Analysen werden insbesondere 
die Kreuzungs- und Überholszenarien herangezogen, da andere Szenarien wie Ge- 
genverkehr und Hindernis als vereinfachte Spezialfälle des Überholens aufgefasst 
werden können. Das Szenario Kreuzung 1 (übernommen aus IVacekü7| ) beinhal- 
tet drei Kreuzungen in einem innerstädtischen Straßennetz. Es wird genutzt, um 
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Szenario 


M 


rr/ 


Instanzen 


Straßcnverlauf 


Cicgenverkchr 1 


2 




19,21 




26 


Gerade 


( jeeenverkehr 2 


2 




10,32 




30 


Kurve 


Hindernis I 


2 




21,27 




35 


Kurve, 3-spurig 


Hindernis 2 


3 




19, 22 




30 


Gerade 


Hindernis 3 


3 




29. 10] 


26 


Gerade 


Hindernis 4 


3 




27, 40] 


20 


Gerade 


Überholen 1 


1 




19.21] 


38 


Gerade 


Überholen 2 


4 




19,21| 


38 


Gerade 


Überholen 3 


4 


[20.31] 


30 


Gerade 


Überholen 4 


4 


[29, 35] 


30 


Gerade 


Überholen 5 


4 


[19,23] 


30 


Kurve 


Kreuzung 1 


4 


11.5 


151 


rechtwinklig, Kurven 


Kreuzunsi 2 


2 6 




15.25 




11 


rechtwinklig 


Kreuzung 3 


2 G 


30 


20 


rechtwinklig 


Kreuzung 4 


4,6 


[15,30] 


20 


rechtwinklig, 4-spurig 


Kreuzung 5 


2,3,4 


[10,30] 


40 


spitzwinklig 



Tabelle 6.2: Liste der Szenarien zum Vergleich der kooperativen Bcwegungspla- 
nungsverfahren. Zu jedem Szenario sind die Anzahl M der beteiligten Fahrzeuge, 
das Intervall der auftretenden Geschwindigkeiten vel in m/s, die Anzahl der ge- 
nerierten Probleminstanzen und Besonderheiten beim Straßenverlauf aufgeführt. 
Wenn nichts anderes angegeben ist, werden 2-spurigc Straßen verwendet. 




Abbildung 6.10: Kooperative Fahrmanöver im Szenario Gegenverkehr 2, berech- 



net mit der Methode der elastischen Bänder (vgl. Abb. 1.2 auf Seite 3). 




Abbildung 6.11: Kooperativer Bewegungsplan im Szenario Hindernis 1, berech- 
net mit der Methode der elastischen Bänder. 
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HB 

(a) Anfangszustand einer Probleminstanz 



. _ jnsranniiirr.ga 




EZB 



(b) prioritäLsbasicrte Planung 
Abbildung 6.12: Szenario Überholen 1. 
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(a) Anfangszustand 
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(b) Baumsuche, Anfangsstück des Plans 




]3 



(c) Baumsuche 



iMiMiitTr^-i^ 



(d) gemischt-ganzzahlige lineare Programmierung, rechteckige Geometrie 



■■■■■■miHiiiii 



(e) elastische Bänder 



(f) prioritätsbasierte Planung 
Abbildung 6.13: Geplante kooperative Fahrmanöver im Szenario Überholen 2. 
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Abbildung 6.14: In einer anderen Probleminstanz von Szenario Überholen 2 findet 
der Baumsuchalgorithmus eine alternative Manöverkombination, 




Abbildung 6.15: Kooperative Fahrmanöver in einer Probleminstanz von Szena- 
rio Kreuzung 1, berechnet mit dem Baumsuchalgorithmus. Die Gefahrensituation 
wird in diesem Beispiel von Fahrzeug ci verursacht, dass beim Abbiegen die Vor- 
fahrt der entgegenkommenden und kreuzenden Fahrzeuge missachtel. Im koope- 
rativen Bewegungsplan bremsen alle vier Fahrzeuge bis zum Stillstand ab. 



Abbiegemanöver mit vergleichsweise langsamen Geschwindigkeiten zu simulie- 
ren. In den anderen Kreuzungsszenarien wird eine Kreuzung von den Fahrzeugen 
mit höheren Geschwindigkeiten geradeaus überquert. Die verschiedenen Überhol- 
und Hindernisszenarien unterscheiden sich vorwiegend durch die auftretenden Ge- 
schwindigkeiten und die relativen Fahrzeugposilionen im Anfangszustand. 



In den Abbildungen 6.10 bis 6.17 sind ausgewählte Planungsergebnisse für eini- 
ge Szenarien dargestellt. Zur Visualisierung werden die Fahrzeugpositionen ge- 
mäß dem kooperativen Bewegungsplan mit einer Abtastzeit von 50 ms dargestellt. 
Längsbeschleunigungen werden farblich hervorgehoben: Bremsverzögerungen in 
rot, positive Längsbeschleunigungen in grün. Meistens wird nicht der gesamte Pla- 
nungshorizont dargestellt, damit die Interpretierbarkeit der Abbildungen möglichst 
wenig durch die gegenseitige Vcrdeckung der Bewegungen verschiedener Fahr- 
zeuge beeinträchtigt wird. 

Sofern korrekte Pläne gefunden werden, sind die Ergebnisse der verschiedenen 
Algorithmen i. d. R. ähnlich in dem vSinne, da-ss sie der gleichen IIomotopieklas.se 
angehören (vgl. Abschnitt 5.H i. Daher können die resultierenden Bewegungsplä- 
ne nach einem Glättungsschritt als weitgehend äquivalent gelten. Nur in wenigen 
Fällen werden deutlich abweichende L ösungen ge fun den, z . B. das Einscheren in 



eine andere Lücke im Übcrholszenario (Abb. 6.13 



und 



T4|. 



I 
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(a) Probleminstanz zur Simulationszeit / = 2.2 s 




(b) Probleminstanz zur Simulationszeit t = 3.0 s 



Abbildung 6.16: Kooperative Fahrmanöver im Szenario Kreuzung 2, M = 4, ge- 
plant mit dem Baumsuchalgorithmus. 



6.4.3 Auswertung des Planungserfolgs 

Zur Auswertung eines Szenarios werden die untersuchten Algorithmen auf alle 
erzeugten Probleminstanzen angewandt. Anschließend werden die resultierenden 
Bewegungspläne auf Korrektheit gcpiüft. Ein Plan wird als korrekt klassifiziert. 



I 
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Abbildung 6.17: Kollisionsverrneidung durch Geschwindigkeitsanpassung im 
Szenario Kreuzung 3, M = ü, geplant mit dem Baumsuchalgorithmus. 



wenn er die Anforderungen aus Abschnitt 5.1 erfülh, d.h. wenn Kollisionen ver- 



mieden werden, alle Fahrzeuge auf der zulässigen Straßenfläche bleiben und die 
fahrdynamischen Grenzen eingehalten werden. Diese Überprüfung wird wie in 



Abschnitt 5.6.2 beschrieben automatisiert durchucführt. 



Als Kriterium für den Planungserfolg wird der relative Anteil der korrekt gelösten 
Probleminslanzen eines Szenarios herangezogen. Da nicht bekannt ist. für welche 
Probleminstanzen eine kon'ekte Lösung existiert, wird als Bezu2S2röße die Anzahl 
der von mindestens einem Algorithmus erfolgreich gelösten Instanzen verwendet. 
Ein höherer Planungserfolg kann in vielen Fällen auch so interpretiert werden, 
dass ein späterer Eingriff noch die Verhinderung eines Unfalls ermöglicht. In ei- 
nigen Szenarien erreicht auch der beste Algorithmus weniger als 100% relativen 
Planungserfolg. Das bedeutet, dass ein anderer Algorithmus zusätzliche Problem- 
instanzen lösen kann, insgesamt jedoch eine geringere Erfolgsrate hat. 
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□ zufällige Prioritäten 




MILP Vorgänger/Nachfolger 


n optimierte Prioritäten 




MILP Rechtecke 


■ Baumsuche T — 4 




elastische Bänder 




Gegenverk. 1 Hindernis 1 Hindernis 2 Hindernis 3 Kreuzung 1 



1000 -- 



er. 100 -- 



N 



1> 



1> 



O.Ol 




0.1- 



Gegenverk. 1 Hindernis 1 Hindernis 2 Hindernis 3 Kreuzung 1 



Abbildung 6.18: Vergleich der Algorithmen in verschiedenen Szenarien. Das obe- 
re Diagramm zeigt den relativen Planungserfolg in %. Unten zeigen die vorderen 
Balken die Mittelwerte der Rechenzeil über die gelösten Probleminstanzen in lo- 
garilhmischer Darstellung. Die hinteren Balken entsprechen der maximalen Re- 
chenzeit. 



Abbildung 6.18 zeigt den Planungscrfolg in verschiedenen Szenarien. In dem ein- 



fachen Gegenverkehrsszenario aus Abb. 2. 1 auf Seite 23 zeigt sich eine deutli- 
che Überlegenheit der kooperativen Algorithmen gegenüber der prioritätsbasierten 
Planung. Ausweichmanöver bei einem stehenden Hindernis können hingegen auch 
von der prioritätsbasierten Planung gefunden werden, wenn den ausweichenden 
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□ zufällige Prioritäten 




MILP Vorgänger/Nachfolger 


n optimierte Prioritäten 




MI LP Rechtecke 


■ Baumsuche T— 3 




elastische Bänder 




3 4 

Anzahl Fahrzeuge M 



5000 
1000 



* 100 -- 



N 



1> 



1> 




O.Ol 



Anzahl Fahrzeuge M 



Abbildung 6.19: Vergleich der Bewegungsplanungsverfahren im Szenario Kreu- 
zung 2. 



Fahrzeugen die höchste Priorität zugewiesen wird. Vorteile für die kooperativen 
Algorithmen ergeben sich nur dann, wenn das ausweichende Fahrzeug vor dem 
Spurwechsel seine Geschwindigkeit anpassen muss, um eine Kollision mit den 
Fahrzeugen auf der Zielspur zu vermeiden. Neben der prioritätsbasierten Planung 
gehört in den Hindernisszenarien die Methode der elastischen Bänder zu den er- 
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□ zufällige Prioritäten 




MILP Vorgänger/Nachfolger 


n optimierte Prioritäten 




Ml LP Rechtecke 


■ Baumsuche T— 3 




elastische Bänder 
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70 -f 



Überholen 1 Überholen 2 Überholen 3 Überholen 4 Überholen 5 
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Überholen 1 Überholen 2 Überholen 3 Überholen 4 Überholen 3 



Abbildung 6.20: Vergleich der Algorithmen in verschiedenen Überholszenarien 
(vgl. |Tübcllc 6.2f . 



folgreichsten Verfahren. Die Baumsuche zeigt ebenfalls eine hohe Erfolgsrate, die 
lediglich im Szenario Hindernis 2 von der groben Zeitdiskretisierung beeinträch- 
tigt wird. Die gemischt-ganzzahlige lineare Programmierung schneidet aufgrund 
der linearen Approximation der Geometrie und Dynamik insbesondere im Szena- 
rio Hindernis 1 etwas schlechter ab. 

Im Szenario Kreuzung 1 können Baumsuche und optimale prioritätsbasierte Pla- 
nung alle Problcminstanzen korrekt lö.scn. Bei der Methode der elastischen Bänder 
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ist wegen der lokalen Optimierung die Abbiegerichtung der Fahrzeuge an einer 
Kreuzung bereits durch die Initialisierung festgelegt. Wenn zur Kollisionsvermei- 
dung eine andere Abbiegerichtung gewählt werden müsste, schlägt die Planung 
fehl. Die eingeschränkte Bcrück.sichtigung der Fahrzeugdynamik wirkt sich eben- 
falls in einigen Instanzen negativ aus. Am schlechtesten schneidet in diesem Sze- 
nario die gemischt-ganzzahlige lineare Programmierung ab, da der Approximati- 
onsfehler in den linearen Modellen für Fahrzeug- und Straßengeometrie bei den 
Abbiegevorgängen mit relativ niedrigen Geschwindigkeiten stärker ins Gewicht 
fällt als in anderen Szenarien. 

Im Szenario Kreuzung 2 ( |Abb. 6.19} kann eine Kollisionsvermeidung in vielen 
Fällen durch Geschwindigkeitsanpassung, also durch longitudinale Verzögerung 
oder Beschleunigung, erreicht werden ( |Abb. 6.l6(a)| und [6.17^ . Wegen der höhe- 
ren Geschwindigkeiten sind anders als im Szenario Kreuzung 1 Abbiegemanö- 
ver nur selten möglich. Bei einer prioritätsbasierten Planung werden für die hö- 
her priorisierien Fahrzeuge konstante Geschwindigkeiten eingeplant, während die 
niedriger priorisierten Fahrzeuge nötigenfalls abbremsen. Die anderen Verfahren 
können gleichzeitig zum Bremsen des einen Fahrzeugs ein Beschleunigen des an- 
deren Fahrzeugs planen. Wegen der im Vergleich zur Bremsfähigkeit betragsmä- 
ßig geringer anzusetzenden Beschleunigungsfähigkeit können dadurch nur relativ 
wenige Probleminstanzen zusätzlich gelöst werden. In anderen Probleminstanzen 
ist eine Kollisionsvermeidung nicht mehr durch reine Geschwindigkeitsanpassung 
möglich, sondern nur noch durch kombinierte Brems- und Ausweichmanöver wie 
in [Abb. 6.l6(b)| Hier zeigen sich deutlichere Nachteile für die priori tätsbasierte 
Planung, da kooperative Handlungen mehrerer Fahrzeuge erforderlich sind, die 
durch die Entkopplungsannahmen der Priorisierung ausgeschlossen werden. Sol- 
che Probleminstanzen sind im Szenario mit M = 4 besonders relevant. Die drei 



Algorithmen aus |Kapitel 5| können prinzipiell die erforderlichen kooperativen Ma- 
növer finden. Beim Baumsuchalgorithmus wirkt sich allerdings die grobe Zeitdis- 
kretisierung negativ auf den Planungserfolg aus, während bei den beiden ande- 
ren Verfahren der Handlungsspielraum wegen der approximativen Modellierung 
der Dynamik nicht voll ausgeschöpft werden kann. Über alle Szenarien hinweg 
halten sich diese Effekte in etwa die Waage. Der Planungserfolg der gemischt- 
ganzzahligcn linearen Programmierung lässt ab Af > 1 deutlich nach, da die Be- 
rechnung in vielen Instanzen nicht innerhalb des Zeitlimits von einer Stunde ter- 
miniert. 



Ein differenziertes Bild zeigt sich in den Uberholszenarien ( Abb. 6.20 . Sie er- 
fordern einerseits die Kollisionsvermeidung mit dem Gegenverkehr, andererseits 
einen abgestimmten Spurwechsel wie in den Hindernisszenarien. Der Erfolg der 
prioritätsbasierten Planung hängt wesentlich davon ab, welches der beiden Ma- 
növer aufgrund der jeweiligen Anfangszuständc zeitkritischer ist, da .sie wie oben 
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gezeigt bei Spurwechseln deutlich erfolgreicher ist als in Gegenverkehrssituatio- 
nen. Des Weiteren hat die Breite der Straße einen großen Einfluss. Wenn genügend 
lateraler Spielraum zur Verfügung steht, findet die prioritätsbasierte Planung häu- 



fig Lösungen, in denen drei Fahrzeuge nebeneinander manövrieren (Abb. 6.1 3(f 
Bei den anderen Algorithmen ist ein Nebeneinanderfahren mit sehr geringem Ab- 
stand wegen der Zeitdiskretisierung oder wegen der überapproximierenden Geo- 
metriemodellierung nur eingeschränkt möglich. Die beobachtete Erfolgsrate der 
prioritätsbasierten Planung ist nur mit der feineren Zeitdiskretisierung erreichbar. 
Wenn die gleiche Anzahl an Entscheidungszeitpunkten verwendet wird wie für 
den Baumsuchalgorithmus, fallen die Ergebnisse erheblich schlechter aus. Dieser 
Unterschied ist in den Hindernisszenarien deudich geringer. Insgesamt gesehen 
sind Baumsuche und MILP die erfolgreichsten Verfahren in den fünf Überholbei- 
spielen. Die elastischen Bänder sind das beste Verfahren in Überholen 1 und in 
Überholen 5, zeigen aber in den anderen drei Szenarien einen deutlich geringe- 
ren Planungserfolg. In den meisten Fällen finden sie zwar eine vielversprechen- 
de Handlungskombination, können aber bedingt durch die implizite Modellierung 
nicht immer einen korrekten Bewegungsplan daraus ableiten. Dies gilt besonders 
dann, wenn wenig Freiraum zwischen den Fahrzeugen zur Verfügung steht. 

Die beiden Varianten der gemischt-ganzzahligen linearen Programmierung errei- 
chen in den meisten Szenarien einen vergleichbaren Planung.serfolg. Nachteile für 
das rechteckige Geometriemodell ergeben sich erwartung.sgemäß in Szenarien wie 
Kreuzung 1 und Hindernis 1, da es die dort auftretenden Rotationen der Fahrzeuge 
nicht ausreichend berücksichtigt. Das bessere Abschneiden in den Szenarien Hin- 
dernis 3 und Kreuzung 2 sowie in einigen Überholszenarien ist überwiegend darauf 
zurückzuführen, dass die Variante mit Kollisionsvermcidung über die Vorgänger- 
und Nachfolgerposition öfter am Zeidimit von einer Stunde scheitert. 

Bei der prioritätsbasierten Planung ist generell festzustellen, dass die Ergcbnis.sc 
mit optimierten Prioritäten erheblich besser ausfallen als mit willkürlichen Priori- 
täten. Dieser Effekt nimmt außerdem mit der Anzahl der kooperativen Fahrzeuge 
zu. Für den Einsatz der prioritätsbasierten Planung ist es daher essendell, eine gute 
Prioritätszuordnung für die jeweilige Probleminstanz zu finden. Dies kann entwe- 
der mit einer Optimierung über alle Permutationen erreicht werden, was aber mit 
erheblichem Rechenaufwand verbunden ist, oder eventuell mit geeigneten Heuris- 



tiken für die Wahl der Prioritäten, wie in Abschnitt 6.4. 1 .5 erläutert. Unabhängig 



von der Wahl der Prioritätsreihenfolge ist der Planungserfolg lediglich in den Sze- 
narien Gegenverkehr 1 und Kreuzung 2, M = 1, die eine symmctri.schc Konstella- 
tion der Fahrzeuge aufweisen. 
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6.4.4 Auswertung des Rechenaufwaiids 

Als zweites quantitatives Evaluationskritei ium wird die gemessene Rechenzeit der 
Bcwcgungsplanungsalgorithmen verwendet. Da die Rechenzeit von verschiedenen 
Faktoren wie Rcchnerhardwarc, Betriebssystem und Implementierung becinflusst 
wird, können die gemessenen Werte lediglich als Anhaltspunkt für die erreichbare 
Größenordnung der Laufzeit und für die Abhängigkeit vom untersuchten Szena- 
rio dienen. Die Zeiten wurden bei der sequenziellen Ausführung der Algorithmen 
auf einem einzelnen Prozessorkern gemessen. Auf eine Mittelung über mehre- 
re Durchlaufe wird verzichtet, da es sich um deterministische Algorithmen han- 
delt und äußere Einflüsse beispielsweise durch das Betriebssystem gegenüber den 
untersuchten Effekten vernachlässigbar sind. Der gemessene Rechenaufwand der 
prioritätsbasierten Planung wird nicht bewertet, da die hier verwendete Implemen- 
tierung diesbezüglich nicht optimal ist. 

Für ein echtzeitfähiges kooperatives Kollisionsvermeidungssystem muss die Be- 
wegungsplanung zuverlässig innerhalb weniger Zehntelsekunden möglich sein, 
sodass ein automatischer Eingriff eine kürzere Reaktionszeit hat als menschliche 
Fahrer. Es kann davon ausgegangen werden, dass dieses Potenzial für einen Algo- 
rithmus vorhanden ist, wenn er in den hier durchgeführten Messungen Rcchcnzei- 
ten in der Größenordnung von einer Sekunde erreicht. Mit schnelleren Rechnern, 
einer verbesserten Implementierung und vor allem einer Parallelisierung der Al- 
gorithmen sollte dann eine echtzeitfähige Realisierung möglich sein. 



6.4.4.1 Rechenaufwand in verschiedenen Szenarien 



Die unteren Diagramme in den Abbildungen 6. 18 bis 6.20 zeigen die gemesse- 
nen Rechenzeiten in den analysierten Szenarien. Da die Werte in unterschiedli- 
chen Größenordnungen liegen, wird eine logarithmische Skalierung verwendet. 
Der vordere Balken stellt jeweils den mittleren Rechenaufwand über alle gelösten 
Probleminstanzen des Szenarios dar, der hintere die maximale gemessene Rechen- 
zeit. Eine weitergehende statistische Auswertung der Messwerte erscheint nicht 
sinnvoll, da die Probleminstanzen keine Zufallsstichprobe darstellen. In der Aus- 
wertung des Rechenaufwands wurden nur diejenigen Probleminstanzen berück- 
sichtigt, für die der jeweilige Algorithmus eine korrekte Lösung finden konnte. Für 
den realen Einsatz eines Algorithmus könnte dann eine entsprechende Maximal- 
zeit vorgegeben werden, bei deren Überschreitung das Problem als unlösbar einge- 
stuft wird. Wenn die nicht gelösten Probleminstanzen ebenfalls in die Auswertung 
einbezogen würden, wären für die gemischt-ganzzahlige lineare Programmierung 
erheblich höhere Rechenzeiten zu verzeichnen. Bei den anderen Aluorithmen hätte 
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dies hingegen geringe Auswirkungen, insbesondere bliebe die maximale Rechen- 
zeit in den meisten Fällen unverändert. Die maximale Rechenzeit ist im Hinblick 
auf die Echtzeitfähigkeil von großer Bedeutung, zumal sie häufig in besonders kri- 
tischen Gefahrensituationen beobachtet wird, in denen kooperative Fahrmanöver 
einen Gewinn gegenüber dem Einzelfahrzeugverhalten erreichen können. 

In den vergleichsweise einfachen Szenarien aus Abb. 6. 18] liegen Baumsuche und 



elastische Bänder durchgehend im für die Echtzeitfähigkeit angestrebten Bereich, 
Für die gemischt-ganzzahlige lineare Programmierung ist dies lediglich in den ers- 
ten drei Szenarien der Fall. Im Szenario Kreuzung 1 mit vier kooperativen Fahr- 
zeugen und im Szenario Hindernis 3, das wegen der höheren Geschwindigkeiten 
eine feinere Zeitdiskreiisierung erfordert, ist der Rechenaufwand bereits deutlich 
größer. 

Das Szenario Kreuzung 2 wird genutzt, um die Skalierbarkeil mit der Anzahl 
AI der kooperativen Fahrzeuge zu untersuchen ( |Abb. 6.19) . Zu beachten ist da- 
bei, dass die Schwierigkeit der Planungsaufgabe nicht nur direkt in Abhängig- 
keit der mit M wachsenden Anzahl der Freiheilsgrade ansteigt, sondern dass auch 
zunehmend komplexe Fahrmanöver zur Abwendung der Gefahrensiluationen er- 
forderlich werden. Die beste Skalierbarkeit mit der Anzahl der Fahrzeuge zeigt 
die Methode der elastischen Bänder, bei der nur die Berechnung der Kraftkom- 
ponente f^^^P quadratischen Aufwand in M hat, während alle anderen Schritte 
linear mit der Anzahl Fahrzeuge skalieren. Beim Baumsuchalgorilhmus mit r = 3 
Enlscheidungszeitpunklen steigt die benötigte Rechenzeit ab M > 4 kooperativen 
Fahrzeugen deutlich an. Der gemessene Aufwand ist im Kreuzungsszenario er- 
heblich größer als in anderen Szenarien mit vier Fahrzeugen, in denen zum Teil 
T = \ Entscheidungszeitpunkte praktikabel sind. Der Grund könnte in der direkten 
Wechselwirkung aller beteiligten Fahrzeuge liegen, wodurch eine große Zahl von 
Handlungskombinationen exploriert werden muss. Anders als in den anderen Sze- 
narien wird für Kreuzung 2 mit M > 4 auch die Kollisionsinformation vorberech- 
net (Pcoii = T). Für M = 4 ist die durchschnittliche Rechenzeit bei Verzicht auf die 
Vorberechnung der Kollisionsinformation (Pcoii = 0) etwas geringer, die maximale 
Rechenzeit hingegen höher. Für M > 5 überwiegen die Vorteile der vollständigen 
Vorberechnung eindeutig. Dennoch entfällt ein großer Teil des Rechenaufwands 
auf die Suche nach der besten Handlungssequenz in B. Erklären lässt sich dies da- 
durch, dass die unteren Schranken wegen der gleichzeitigen Wechselwirkung von 
mehr als zwei Fahrzeugen in diesem Szenario keine gute Abschätzung darstellen. 
Die gemischt-ganzzahlige lineare Programmierung zeigt einen noch stärkeren An- 
stieg des Rechenaufwands mit der Anzahl der Fahrzeuge. Während das Verfahren 
für AI = 2 und M = 3 innerhalb von et\s'a einer Zehntelsekunde bzw. einer Se- 
kunde korrekte Lösungen finden kann, wird bereits bei AI = 4 in vielen Problem- 
instanzen das Zeitlimit von einer Stunde überschritten. Für eine Probleminstanz 
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wurde nach mehr als zehn Stunden eine kollisionsfreier Plan gefunden. Um fest- 
zustellen, dass eine KoUision unvermeidbar ist, braucht das Verfahren häufig noch 
deutlich länger. 

In den Überholszenarien mit M = 4 Fahrzeugen erreichen wiederum Baumsuche 
mit T = 3 und elastische Bänder Rcchcnzciten in der angestrebten Größenordnung 
( |Abb. 6.20| ). Der Baumsuchalgorithmus ist auch mit der feineren Zeitdiskretisie- 



rung von T = 4 in den meisten Problem instanzen noch praktikabel und zeigt einen 
etwas besseren Planungserfolg. Die maximale Rechenzeit steigt auf etwa eine 
Minute. Dieses Maximum wird aber nicht in den zusätzlich gelösten Problem- 
instanzen angenommen, sondern in weniger kritischen Situationen, in denen noch 
ein größerer Handlungsspielraum besteht (siehe dazu auch |Abschnitt 6.4.4. 2| . Die 
gemischt-ganzzahlige lineare Programmierung benötigt in den meisten Überhol- 
szenarien deutlich längere Rechenzeiten. Gegen einen Einsatz unter Echtzeitbe- 
dingungen spricht außerdem die große Varianz des Rechenaufwands über die ver- 
schiedenen Probleminstanzen und Szenarien. 

Wie zu erwarten, ist die Variante mit rechteckiger Fahrzeuggeometrie i.d. R. 
schneller, da sie weniger binäre Variable benötigt. In den Szenarien Kreuzung 2, 
Hindernis 3, Überholen 3 und Überholen 5 kann mit diesem Modell eine deut- 
lich größere Anzahl Probleminstanzen innerhalb des Zeitlimits von einer Stunde 
gelöst werden als mit der Modellierung über Vorgänger- und Nachfolgerpositi- 
on. Der Unterschied zu den anderen Überholszenarien erklärt sich in Überholen 3 
durch die feinere Zeitdiskretisierung aufgrund der höheren Geschwindigkeit und 
in Überholen 5 durch die zusätzlichen binären Variablen für die Modellierung des 
Kurvenverl aufs. Durch zusätzlich erforderliche binäre Variable kann der Aufwand 
exponentiell mit der Anzahl der Hindernisse, Straßenpolygone und Abtastzeit- 
punkte ansteigen. Der erhebliche Einfluss der Anzahl Hindernisse wurde bereits in 
anderen Arbeiten beobachtet IBrancaOöl . Dies ist ein grundsätzlicher Nachteil des 
MILP-Ansatzcs, da die theoretische obere Schranke für den Rechenaufwand der 
Bewcgungsplanung polynomicU in der Anzahl der Hindernisse ist llLatombe9 1 1 
Abschnitt 1.6J. 



6.4.4.2 Rechenaufwand in verschiedenen Probleminstanzen eines Szenarios 

Abbildung 6.21| zeigt den Verlauf der Rechenzeiten für die drei kooperativen Be- 
wegungsplanungsalgorithmen über die Probleminslanzen eines Überholszenarios. 
Zunächst ist noch kein Eingriff innerhalb des Planungshorizonts von = 2.4 s 
notwendig. Für diese Problem instanzen fällt beim Baumsuchalgorithmus im We- 
sentlichen der Vorberechnungsaufwand an, während die Rechenzeit für die Suche 
im Baum B der kooperativen Handlungssequenzen vernachlässigt werden kann. 



6.4 Vergleich der Algorithmen zur Bewegungsplanung 



171 



5üUl) 




ü.ül ' 1 • ^ ' ^ ' 1 

Ü 0.5 i 1.5 2 2.5 3 3.5 

Pniblcmin.stanz (Simulationszcit / in s) 

Abbildung 6.21: Verlauf der Rechenzeit über die Probieminstanzen von Szenario 

Überholen 2. 

Ab einer Simulationszeit von etwa f — 2 s wird ein kollisionsvermeidendes Ma- 
növer erforderlich. Während der Vorberechnungsaufwand nahezu konstant bleibt, 
steigt die benötigte Rechenzeil für die Suche in ß inklusive der Kollisionslests 
nun deutlich an. Der Aufwand ist für diejenigen Probleminstanzen am größten, bei 
denen eine große Anzahl kollisionsfreier Alternativen in den oberen Ebenen des 
Baums exploriert wird. Wenn die Situation so kritisch wird, dass die Kollisions- 
gefahr bereits zu Beginn des Planungshorizonts besteht, sinkt der Rechenaufwand 
wieder, da die Teilbäume mit Kollisionen nun früher von der Suche ausgeschlos- 
sen werden können. Diese Tendenz setzt sich auch in den Probleminstanzen fort, 
für die der Baumsuchalgorithmus keine korrekte Lösung finden kann. Dies lässt 
sich damit erklären, dass bereits in den oberen Ebenen von B eine Kollision als 
unvermeidbar erkannt wird. 

Für die anfänglichen Problem Instanzen sind beim MILP- Verfahren die kürzes- 
ten Rechenzeilen aller Algorithmen zu beobachten. Anschließend steigt der Pla- 
nungsaufwand jedoch deutlich an, sodass ein echlzeiifähiger Einsatz des Verfah- 
rens nicht praktikabel erscheint. Das Ml LP- Verfahren benötigt häufig auch sehr 
laniie, um zu erkennen, dass eine Problcminstanz nicht lösbar ist. Am Ende des 
Szenarios (/>3.6 s) kann bereits durch die Eneichbarkeitsbetrach langen festge- 
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stellt werden, dass eine Kollision nicht mehr verhindert werden kann (siehe Ab- 
schnitt 5.4Ä\ . 



Bei der Methode der elastischen Bänder ist der Rechenaufwand über alle Problem- 
instanzen naliezu konstant. 



6.4.5 Vergleichende Bewertung 



Beim Vergleich der Planung im Raum der kooperativen Handlungen aus Ka- 



pitel 5 mit dem vStandardverfahren der prioritätsbasierten Planung zeigt sich, 
dass die Auswirkunaen der einschränkenden Priorisierunasannahmen auf den 
Planungselfolg stark vom untersuchten Szenario abhängen. Ausweichmanöver 
vor einem stehenden Hindernis können i.d. R. auch mit einer tieeigneten Priori- 
tätszuordnung gefunden werden, während die Priorisierungsannahme selbst mit 
optimal gewählten Prioritäten die Möglichkeilen zum kooperativen Handeln in 
Gegenverkehrs- und Kreuzungsszenarien erheblich einschränkt. In komplexen 
Szenarien wie z.B. bei Überholmanövern variieren die Auswirkungen in Abhän- 
gigkeit von der konkreten Probleminstanz, da der Straßenrand und andere Fahr- 
zeuge häufig einige der kooperativen Handlungsmöglichkeiten blockieren. Somit 
ist die Hrfolgsrate der prioritätsbasierten Planung in komplexen Szenarien höher 
als im einfachen Szenario Gegenverkehr 1, das sozusagen den schlimmsten Fall 
für einen prioritätsbasierten Planer dar.stcllt. 

Die vorgestellten Simulationen zeigen, dass die Ergebnisse der Algorithmen zur 
kooperativen Planung je nach Szenario und Anzahl der beteiligten Fahrzeuge 
variieren. Je nach Szenario, zum Teil auch bei sehr ähnlichen Szenarien, cnei- 
chen unterschiedliche Algorithmen den höchsten Planungserfolg. Die Baumsuche 
zeigt insgesamt eine gute Erfolgsrate, allerdings wirkt sich in manchen Problem- 
instanzen die grobe Zeitdiskretisierung negativ aus. Die Methode der elastischen 
Bänder gchc)rt in vielen Szenarien zu den erfolgreichsten Planern, liegt aber in 
anderen deutlich zurück, was vor allem auf die impliziten und damit approxima- 
tiven Geometrie- und Dynamikmodelle sowie auf die lokale Optiinierung zurück- 
geführt werden kann. Die gemischt-ganzzahlige lineare Programmierung erreicht 
ebenfalls in manchen Szenarien den höchsten Planunaserfola, scheitert aber bei 
einer größeren Anzahl kooperativer Fahrzeuge häufig am stark ansteigenden Re- 
chenaufwand. Die Einschränkungen der linearen Modelle wirken sich besonders 
bei niedrigen (leschwindigkeiten und bei größerer Krümmung des Straßenverlaufs 
aus, z. B. in den Szenarien Kreuzung 1 und Hindernis I. 

Hinsichtlich des Rechenaufwands zeigt der Baumsuchalgorithmus in Szenarien 
mit bis zu vier kooperativen Fahrzeugen das Potenzial für eine echtzeitfähige Im- 
plementierung. Die Methode der elastischen Bänder weist die beste Skalierbarkeit 
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mit der Anzahl kooperativer Fahrzeuge auf und ist auch für sechs kooperative Fahr- 
zeuge potenziell in Echtzeit einsetzbar. Der Rechenaufwand des MILP- Verfahrens 
variiert sehr stark mit der Probleminstanz, sodass eine Echtzeittahigkeit in komple- 
xeren Szenarien momentan kaum erreichbar scheint. Bereits im Szenario Hinder- 
nis 3 mit drei kooperativen Fahrzeugen und einem Hindernis treten Rcchenzcitcn 
von mehreren Stunden auf, ebenso in Szenarien mit vier oder mehr kooperativen 
Fahrzeugen. 

Insgesamt kann festgestellt werden, dass die kooperative Planung im Raum der 
gemeinsamen Handlungen in manchen Szenarien deutlich erfolgreicher ist als die 
prioritätsbasierle Planung und dennoch zumindest für bis zu vier kooperative Fahr- 
zeuge das Potenzial für eine echtzeitfähige Realisierung aufweist. 

Im Folgenden werden einige Ursachen für die unterschiedliche Leistungsfähig- 
keil untersucht und die Algorithmen anhand weiterer Beweriungskriterien gegen- 



übergestellt. Abschließend werden einige dieser Kriterien in Tabelle 6.3 auf Seite 
176 zusammengefasst. Die prioritätsbasierle Planung ist dort nicht aufgeführt, da 
sie die meisten Eigenschaften vom darunterliegenden Einzelfahrzeugplaner über- 
nimmt. 



6.4.5.1 Diskretisierung 

Für den Baumsuchalgorithmus werden sowohl die Handlungen als auch die Zeit 
vergleichsweise grob diskretisierl. In manchen Szenarien wie Überholen 1 und 
Kreuzung 2 wird der Planungserfolg dadurch beeinträchtigt. Insbesondere die Zahl 
der Entscheidungszeitpunkte kann einen großen Einfluss auf den Planungserfolg 
haben. Das zeigt sich auch bei der Implementierung der prioritätsbasierten Planung 
mit dem Baumsuchalgorithmus als Einzelfahrzeugplaner. Hier können deutlich 
mehr Entscheidungszeitpunkte verwendet werden, wodurch sich der Planungser- 
folg im Vergleich zu einer prioritätsbasierten Planung mit grober Zeitdiskretisie- 
rung erheblich verbessert. Dass der kooperative Baumsuchplaner dennoch häufig 
besser abschneidet, zeigt die prinzipielle Unvollständigkeit der prioritätsbasierten 
Planung. 

MILP und elastische Bänder können die Handlungen in Form von Beschleuni- 
gungsvektoren kontinuierlich wählen. Die verwendete Zeitdiskretisierung ist fein 
genug, dass sie keine nennenswerte Einschränkung darstellt. 

Interessant ist in diesem Zusammenhang, dass sowohl für die Suche im Baum B 
als auch für die Lösung von MILPs Branch-and-Bound-Methoden verwendet wer- 
den können. Bei der Baumsuche erfolgt die Verzweigung des Branch-and-Bound- 
Vcrfahrcns über die möglichen kooperativen Handlungen a G -4 der Fahrzeuge. 
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In Abhängigkeit der gewählten Ilandlung wird anschließend das Verlustfunktio- 
nal ausgewertet und somit geprüft, ob die Anforderungen an einen kollisionsfreien 
Bewegungsplan erfüllt sind. Bei der MILP-Lösung erfolgt hingegen die Verzwei- 
gung über die binären Variablen, die bei der Bcwcgungsplanung die Koordinatcn- 
richtunu modellieren, in der ein Fahrzeug an einem anderen vorbeifährt. Es wird 
also erst die Entscheidung über die Art der Kollisionsvermeidung getroffen und 
anschließend die dafür erforderliche Handlung in Form der kontinuierlichen Be- 
schleunigungswerle optimiert. Aufgrund dieser unterschiedlichen Herangehens- 
weise wirken sich die Parameter der Modelle und des Szenarios unterschiedlich 
auf den Aufwand der Algorithmen aus. Beim MI LP- Verfahren können feinere 
Geometriemodelle für Fahrzeuge und Straßen sowie zusätzliche Hindernisse einen 
exponentiellen Anstieg der Rechenzeil zur Folge haben, da sie mit zusätzlichen bi- 
nären Variablen verbunden sind. Für die Baumsuche sind die Diskretisierung der 
Handlungen und die Anzahl der Entscheidungszeitpunkte ausschlaggebend für die 
Laufzeit, während Geometriemodelle und Hindernisse nur linear in den Aufwand 
eingehen. 



6.4.5.2 Optimierung 

Baumsuche und gemischt-ganzzahlige lineare Programmierung können innerhalb 
der jeweiligen Annahmen und Modelle die global optimale kooperanve Hand- 
lungssequenz finden. Die Methode der elastischen Bänder nimmt hingegen nur ei- 
ne lokale Optimierung vor, sodass die Lösung von der Initialisierung abhängig ist. 
In der Evaluation wirkt sich dies vor allem bei den Abbiegemanövern im Szena- 
rio Kreuzung 1 aus. Ferner kann vor einem Hindernis eine falsche Ausweichrich- 
lung gewählt werden, sodass beispielsweise das Verlassen der Straße unvermeidbar 
wird. In vielen anderen Szenarien verursacht die lokale Optimierung keine nen- 
nenswerten Nachteile. Die Planung kooperativer Fahrmanöver unterscheidet sich 
darin offenbar von Anwendungen aus der Robotik, in denen vielfach labyrinth- 
artige Umgebungen betrachtet werden. Für den Planungserfolg mit elastischen 
Bändern ist es wesentlich, dass während der Berechnung des Kräftegleichgewichts 
Zustände eingenommen werden können, in denen die Anforderungen an korrekte 
Pläne verletzt sind. Beispielsweise kann ein elastisches Band zur Kollisionsver- 
meidung zunächst so verschoben werden, dass die fahrdynamischen Nebenbedin- 
gungen nicht mehr erfüllt sind. Anschließend werden diese Nebenbedingungen 
von den inneren Kräften wiederhergestellt. Wenn hingegen wie in ||Brandt()5a| 



vorgeschlagen eine harte Durchsetzung der Nebenbedingungen während des ge- 
samten Optimierungsprozesses gefordert wird, können sich die elastischen Bänder 
häufig nicht au.sreichcnd vom Initialisierungszu.stand lösen. 
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Die prioritiUsbasierte Planung kann keine globale Zielfunktion optimieren, da sie 
jedes Fahrzeug separat betrachtet und die Auswirkungen der Einzelfahrzeugent- 
scheidung auf andere Fahrzeuge ignoriert. Eine Folge ist beispielsweise, dass der 
Tcrm L*^""' aus ( 5.24f , obwohl er gar nicht die Kollisionsvermeidung beschreibt, 
Auswirkungen darauf hat, ob ein korrekter kollisionsfreier Plan gefunden werden 
kann. 



6.4.5.3 Modellierung und Erweiterbarkeit 

Der Baumsuchalgorithmus verwendet explizite Modelle und kann daher die Fahr- 
zeuggeometrie, dynamische Nebenbedingungen und Zielvorgaben exakt berück- 
sichtigen. Bei der gemischt-ganzzahligen linearen Programmierung sind we- 
gen der Beschränkung auf lineare Modelle konservative Approximationen der 
Fahrzeug- und Straßengeometrie erforderlich. Dadurch wird insbesondere bei ei- 
nem Straßenverlauf mit kleinen und mittleren Kurvenradien der Manöverspiel- 
raum eingeschränkt. Besonders stark wirkt sich dies bei vergleichsweise niedrigen 
Geschwindigkeiten wie im Szenario Kreuzung I aus, da nur dann Manöver mit 
einer erheblichen Rotation des Fahrzeugs möglich sind. Die Methode der elasti- 
schen Bänder berücksichtigt alle Anforderungen nur approximativ, auch die Kol- 
lisionsvermeidung und die Fahrzeugdynamik. Dadurch wird in manchen Fällen 
kein korrekter Plan zurückgeliefert, obwohl das Verfahren eigentlich eine erfolg- 
versprechende Manöverkombination findet. Dieser Effekt zeigt sich beispielsweise 
in den Szenarien Überholen 2 und Gegenverkehr 2. 

Die verwendete Art der Modellierung wirkt sich auch auf die Möglichkeiten zur 
Integration weiterer Anforderungen und Zielvorgaben aus. Am einfachsten sind 
Erweiterungen bei der Baumsuche, die beliebige explizite Modelle für die Fahr- 
zeuge und das Verlustfunktional berücksichtigen kann. Problematisch ist lediglich 
der Rechenaufwand für detailliertere Modelle, der allerdings durch die Wiederver- 
wendung von Zwischenergebnissen auf die Berechnung der Einzelfahrzeugbäume 
beschränkt bleibt. 

Bei der gemischt-ganzzahligen linearen Programmierung werden die Erweite- 
rungsmöglichkeiten durch die Linearitätsforderung eingeschränkt. Erweiterungen, 
die zusätzliche ganzzahlige Variable benötigen, können einen deutlichen Anstieg 
des Rechenaufwands zur Folge haben. 

Bei der Methode der elastischen Bänder können weitere Nebenbedingungen im- 
plizit durch zusätzliche Kräfte berücksichtigt werden. Da keine explizite Model- 
lierung möglich ist, sind Erweiterungen mit einem höheren Entwicklungsaufwand 
verbunden. 
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Baumsuche 


MILP 


elastische 
Bänder 


Iliindluni'en 


grobe 

Diskretisierunü 


kontinuierlich 


kuntiiiuierlich 


Zcitdiskrctisicrung 


grob 


fein 


fein 


Optimierung 


global 


global 


lokal 


Modelle 


explizit 
beliebig 


explizit 
linear 


implizit 


Min. Kollisionsschwere 


möglich 


ein beschränkt 


nicht möglich 



Tabelle 6.3: Vergleichende CJegenüberstellung der drei kooperativen Bewegungs- 
planungsalgoritlimen aus Kapitel|5] 



6A^A Pärallelisierbarkeit 

Das Baumsuchvorfahron hioioi gute Möglichkeiten für eine Parallelverarbeitung 
auf einem Mehrpro/essorrechner. insbesondere kann in der Vorv erarbeitungsphase 
die Berechnung jedes Einzelfahr/eiigbaiims auf einem eigenen Prozessor durchge- 
fiihrl werden, in der Suchphase kcninen den Prt)zessoren inUerschiedliche Teilbäu- 
rne zugewiesen werden. Mit einer solchen grobgranularen Paralleiisierung sollte 
sich eine hohe LlTizienz erreichen lassen. 

Die Paralleiisierung des MILP- Verfahrens ist ebenfalls möglich, da parallel arbei- 
tende MILP-Löser verfügbar sind. 

Bei der Methode der elastischen Bänder bietet sich eine Aufteilung der Knoten 

p,^jt auf die zur Verfügung stehenden Prozessoren an. Jeder Prozessor berechnet 
die resultierende Kraft für die ihm zugeteilten Knoten. Anschließend ist für jede 
Iteration des Verfahrens ein Synchronisierungsschritt erforderlich, um die Konsis- 
tenz der Ergebnisse sicherzustellen. 

Obwohl die prioritätsbasierte Planung die Aufgabe in mehrere Teilschritte zer- 
legt, können diese nicht ohne weiteres parallel ausgeführt werden. Denn für je- 
de Teilaufgabe werden die Planungsergebnisse der höher priorisierten Fahrzeuge 

bcnckigt. Die Parallelisierbarkeit bleibt daher zunächst auf den verwendeten Ein- 
zelfahrzeugplaner beschränkt. Darüber hinaus könnte allenfalls eine Auslagerung 
von Vorhcrechnungsschritten zu einer teilweise parallelen Berechnung der Einzel- 
probieme beitragen. 

Während alle Algorithmen das Potenzial für eine Paralleiisierung auf einem Mehr- 
prozessorrechner bieten, durfte es kaum möglich sein, die Berechnung auf mehre- 
re kognitive Fahrzeuge zu verteilen, da der notwendige Datenaustausch die Leis- 
tungsfähigkeit des Funknetzwerks übersteigt. 
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Abbildung 6.22: Variante von Szenario Überholen 1 ( Abb. 6. 12 auf Seite 159) mit 
heterogenen Fahrzeugen. 



6.5 Varianten und Erweiterungen der 
Bewegungsplanung 

Die Flexibilität der Bewegungsplanungsalgorithmen erlaubt die Umsetzung ver- 
schiedener Erweiterungen und Varianten, auf die im vorangegangenen Abschnitt 
aus Gründen der besseren Vergleichbarkeit verzichtet wurde. Die meisten dieser 
Erweiterungen und Varianten wurden im Rahmen der vorliegenden Arbeit mit al- 
len drei Algorithmen aus Kapitel 5 realisiert. Die folgende Darstellung erfolgt im 
Wesentlichen am Bcispie des Baumsuchalgorithmus. 



6.5.1 Heterogene Fahrzeugtypen 

In den bisher vorgestellten Simulationen wurde einheitHch das Fahrzeugmodeil ei- 
nes Mittclklassc-Pkws verwendet. Es stellt jedoch keine prinzipielle Schwierigkeit 
dar, eine Bewegungsplanung für heterogene Fahrzeuge durchzuführen, sofern ih- 
re Eigenschaften und Fähigkeiten aus dem gemeinsamen Lagebild bekannt sind. 
Relevant sind hierbei in erster Linie die Abmessungen und die fahrdynamischen 



Fähigkeiten. Als Beispiel zeigt |Abb. 6.22| eine Uberholsituation, an der ein Last- 
wagen und zwei kleinere Fahrzeuge beteiligt sind. Zur Planung wird der Baum- 
suchalgorithmus eingesetzt. Beim Vergleich mit dem Fall homogener Fahrzeuge 
fällt auf, dass der Lastwagen wegen seiner Größe und seiner geringeren Verzöge- 
rungsfähigkeit während eines längeren Zeiliniervalls bremst als das entsprechende 



Fahrzeug in |Abb. 6.12(b)| Die Rechenzeit steigt gegenüber dem Szenario mit ho- 
mogenen Fahrzeugen um etwa 20%, was zum Teil auf den höheren Aufwand für 
Kollisionstests infolge der Geometrie des Lastwagens, zum Teil auf die größere 
Anzahl im Baum ß besuchler Knoten zurückzuführen ist. 



6.5.2 Gemischter Verkehr 



Die kooperative Kollisionsvermeidung ist mit Einschränkungen auch dann mög- 
lich, wenn ein gemischter Verkehr aus kognitiven und nicht kognitiven Fahrzeu- 
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Abbildung 6.23: Variante von Szenario Überholen 1 ( Abb. 6.12 auf Seite 159) mit 
gemischtem Verkehr. 




Abbildung 6.24: Planung bis zum Stillstand im Szenario l Iberholen 2 ( Abb. 6.13 
auf Seite 159). 



gen angenommen wird. In diesem Fall werden die nicht kognitiven Fahrzeuge 
be i der Bewe gungsplanung als bewegte Hindernisse angesehen. Als Beispiel ist 
in Abb. 6.23 eine Überholsituation dargestellt, an der zwei kognitive und zwei 



nicht kognitive Fahrzeugen beteiligt sind. Die Bewegungen der nicht kognitiven 



Fahrzcuuc müssen mit Hilfe von Prädiktionsverfahren emiittclt werden (siehe Ab- 



schnitt 3.5. 1} . Die resultierende Prädiktionsunsicherheit wird ebenfalls bei der Pla- 



nung berücksichtigt. Dadurch ist eine mit der Zeit wachsende Fläche zu vermei- 
den, was in der Abbildung durch die zunehmende Größe der bewegten Hindernisse 
veranschaulicht wird. Der Rechenaufwand des Baumsuchaliiorithmus verrimiert 
sich deutlich, da nur M — 2 kooperative Fahrzeuge beteiligt sind. 



6.5.3 Planung bis zum Stillstand 

In manchen Arbeiten zu Kollisionsvermeidungssystemen wird angenommen, dass 
nur der Stillstand des Fahrzeugs einen ausreichend sicheren Zust^md darstellt 
IKirchner05l . Dies gilt insbesondere dann, wenn der Fahrer nach einer Gefah- 
rensituation wieder die Steuerung des Fahrzeugs übernehmen muss. Bei dem in 
der vorliegenden Arbeit betrachteten Konzept ist dies nicht zwangsläufig der Fall, 
da die kognitiven Fahrzeuge über Fähigkeiten zum autonomen Fahren auf Ein- 
zelfahrzeugebene verfügen. AuISerdem stellen starke Bremsmanöver und stehen- 
de Fahrzeuge ein Risiko für weitere Unfälle dar und behindem den Verkehrsfluss. 
Aus diesen Gründen wurde hier auf die Forderung verzichtet, dass ein kooperatives 
Fahrmanöver mit dem Stillstand aller Fahrzeuge enden muss. Mit den vorgeschla- 
genen Bewegungsplanungsalgorithmen kann dies aber sehr wohl erreicht werden, 
Wiedas Beispiel in |Abb. 6.24| zeigt. Beim Baumsuchalgorithmus wird die Funktion 
^^^l^^''^{ncc, acc]a.x) in (|5.25| so modifiziert, dass Bremsverzögerungen gegenüber 
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einem Fahren mit konstanter Geschwindigkeit bevorzugt werden. Die prinzipiell 
zulässigen Fahrmanöver werden dadurch nicht eingeschränkt, insbesondere kann 
ein Fahrzeug weiterhin beschleunigen, wenn dies zur Kollisionsvermeidung er- 
forderlich ist. Der Rechenaufwand in dem Beispiel sinkt durch die Modifikation 
geringfügig, da weniger Knoten des Baums B besucht werden. 



6.5.4 Iterierte Planung und Ausführung 

Häufig müssen Planung und Ausführung miteinander verzahnt werden, d.h. nach 
der ersten Planung wird mit der Ausführung des Anfangsstücks des Plans be- 
gonnen und währenddessen ein neuer Plan erstellt. Eine iterierte Planung kann 
einerseits erforderlich sein, weil der Planungshorizont aus Gründen des Rechen- 
aufwands begrenzt werden muss. Wenn die Gefahrensituation innerhalb des ur- 
sprünglichen Plans nicht vollständig abgewendet werden kann, wird eine Neupla- 
nung erforderlich. Andererseits können neue Beobachtungen eine Anpassung des 
Plans erfordern, wenn beispielsweise auf ein unerwartetes Verhalten eines nicht 
kooperativen Vcrkchrsteilnehmers oder auf ein erstmals erkanntes Hindernis rea- 
giert werden muss. 

Im Fall einer iterierten Planung und Au.sführung muss der maximale Zeitabstand 
von tu zwischen den Planungs.schritten bei der Wahl des Planungshorizonts be- 
rücksichtigt werden. Kriterium ( |6.5| verschärft sich dadurch zu 

> ^it + inax istop,/ . (6.9) 
1=1 

Die einzelnen Bewegungsplanungsalgorithmen können in unterschiedlicher Weise 
für die iterierte Planung und Ausführung angepasst werden. Bei der Methode der 
elastischen Bänder kann die Initialisierung der Knoten anhand des Plans aus der 
vorigen Iteration erfolgen. Da sich diese Knoten bereits im Kräftegleichgewicht 
befinden, wird häufig die Konvergenz des Verfahrens beschleunigt. Lediglich die 



Knoten im Intervall (^h — ^ii- th\ werden wie in Abschnitt 5.5.3 beschrieben gemäß 
einem prädizierten Fahrspurfolgeverhalten initialisiert. 

Für den Baumsuchalgorithmus sollte das Planungsintervall tu in Übereinstim- 
mung mit den Entscheidungszeitpunkten gewählt werden: t\t = tk für ein k € 
{1, - . . , T — 1 }. Damit wird sichergestellt, dass die Fortführung des begonne- 
nen Plans in der nächsten Iteration nicht durch eine ungünstige Wahl der Zcit- 
diskretisierung unmöglich wird. Außerdem können Teilbäume mit Information 
aus den Vorberechnungsschritten weiterverwendet werden. Da jedoch mindestens 
die unterste Ebene der Bäume neu hinzukommt, ist die mögliche Reduktion des 
Rechenaufwands eher gering. Die Problematik unterscheidet sich erheblich von 
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der inkrcmcntellen gitterbasierten Planung mit dem D'^-Algorithmiis (siehe lAb- 



schnilt 2.3 .3}: Dort beschreiben die Knoten des Gitters feste räumliche Positionen 



und die inkremcnielle Anpassung bezieht sich auf aktualisierte Hindernisinforma- 
tion, während bei der kooperativen Kollisionsvcrmcidung die Knoten von ß Fahr- 
zeugzustände in Abhängigkeit der Anfangspositionen beschreiben und das zeidi- 
che Planungsintervall in jeder Iteration verschoben wird. Daher ist die inkremen- 
telle Graphensuche nach dem D*-Prinzip hier nicht gewinnbringend einselzbar. 

Simulationsergebnisse mit iterierter Planung und Ausführung werden weiter unten 

in 



Abschnitt 6.6 vorgestellt. 



6.5.5 Miiiimierung der Kollisionsschwere 

Die Minimierung der Kollisionsschwere wird an zwei Beispielen mit jeweils 
drei beteiligten Fahrzeugen demonstriert. Im ersten Beispiel ist die Straße für 
ein schnell herannahendes Fahrzeug durch zwei langsam nebeneinander fahrende 
Fahrzeuge blockiert, in diesem Fall wird die Kollision mit dem schnelleren der bei- 
den Fahrzeuge bevorzugt, sodass die Relativgeschwindigkeii beim Aufprall mög- 



lichst gering ist ( |Abb. 6.25(a)| Die Relativgeschwindigkeii wird zusätzlich 
durch geeignete Brems- bzw. Beschlcunigungsmanöver reduziert. Das Auffahren 
auf ein in gleicher Richtung vorausfahrendes Fahrzeug wird gegenüber einem Zu- 



sammenstoß mit dem Gegenverkehr bevorzugt ( Abb. 6.25(c)| . 



Das zweite Beispiel zeigt die Vermeidung eines Scitcnaufpralls mit einem Fahr- 
zeug, das infolge eines vorangegangenen Unfalls oder eines Fahrfchlers auf ei- 
ner Kreuzung zum Stillstand gekommen ist l Abb. 6.26(a)| . Zum Vergleich ist in 



Abb. 6.26(b) eine ähnliches Szenario dargestellt, in dem ein Auffahrunfall mit ei- 



nem in Fahririchtung stehenden Fahrzeug in Kauf genommen wird. 
Zur Planung wird der Baumsuchalgorithmus mit dem Verluslfunktional 

L(7) - L'-~*'"'"(7) + V'^'^'i!) + I"'"''(7) + /-'""'^'(t) (6.10) 



aus 



Abschnitt 5 .3. 2 .3 [ eingesetzt. Dabei wird die A*-Suchstrategie mit den Para- 



metern M -- 3, T = 1, h\\- = 5sv = T, ScoW = T, Pcoii = 0 verwendet. Die Laufzeit 
steigt gegenüber der Minimierung der Anzahl Kollisionen nach dem Verlustfunk- 



tional i6.7 1 um etwa 40 %. bis 50 % an. Dies ist hauptsächlich auf eine größere An- 
zahl besuchter Knoten von ß infolge des geänderten Vcrlustfunktionals zurückzu- 
führen, weniger auf den Aufwand für die Berechnung der Kollisionsschwere. Zum 
Vergleich werden auch Fälle untersucht, in denen eine Kollision gerade noch ver- 
mieden werden kann (z. B. |Abb. 637} . In solchen Situationen liefern beide Varian- 



ten idennsche kooperative Bewegungspläne, und der Rechenaufwand unterschci- 



6.5 Varianien und Erweiterungen der Bewegungsplanung 



181 



n 



(a) 




(b) 



(c) 



Abbildung 6.25: Minimicrung der Kollisionsschvvcrc bei Auffahrunfällcn. 




(a) 
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(b) 

Abbildung 6.26: Minimierung der Kollisionsschwere durch Vermeidung eines 
Seitenaufpralls. 




Abbildung 6.27: Erfolgreiche Koliisionsvermeidung in einer Probleminstanz ähn- 
lich der aus |Abb. 6.25(F)] 
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Abbildung 6.28: Gemessene Rechenzeiten für die Varianten ohne und mit Mini- 
mierung der Kollisionsschwcre (mitdcrc und maximale Gesamtzeit im jeweiligen 
Szenario sowie Anteil der Vorberechnung). 



det sich nur geringfügig. Die gemessenen Rechenzeiten für die drei Varianten Kol- 
lisionsvermeidung (siehe Abschnitt 6.3.3f , Minimierung der Anzahl Kollisionen 
und Minimierung der Kol isionsschwere werden in Abb. 6.28 gegenübergestellt. 

Mit den anderen Bewegungsplanungsalgorithmen aus Kapitel 5( kann die Minimie- 
rung der Kollisionsschwere nicht ohne weiteres realisiert werden. Bei den elas- 
tischen Bändern müssten Kräfte definiert werden, die wie bisher eine Kollision 
wenn möglich verhindern, eine unvermeidbare Kollision aber zulassen. Dies dürf- 
te kaum zu erreichen sein. In das gemischt-ganzzahlige lineare Programm kann im 
Prinzip eine linearisierte Version des Verlustfunktionals £'^""'"(7) aufgenommen 
werden. Insbesondere können binäre Variable eingeführt werden, mit deren Hilfe 
die Anzahl der Kollisionen minimiert werden kann. Allcrdinus zeiijen erste Ver- 
suche in diese Richtung, dass dadurch der Rechenaufwand noch einmal deutlich 
ansteigt, weshalb dieser Ansatz nicht weiterverfolgt wird. 

Mit der prioritätsbasierten Planung ist eine globale Minimierung der Kollisions- 
schwere nicht möglich, weil nur für das niedriger priorisierte Fahrzeug der beiden 
Kollisionspartner ein Manöver zur Minimierung der Kollisionsschwere geplant 
werden kann. 
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(a) Fahrzeugpositionen und Gruppeneinteilung zum Zeitpunkt t — 2.65 s 



(b) kooperativer Bewegungsplan zum Zeitpunkt / — 2.65 s 




(c) Toleranzen r^j, zum Zeitpunkt f = 3.55 s 
Abbildung 6.29: Simulation des Gesamtsystems im Szenario Hindernis 2. 



6.6 Gesamtsystem der verteilten Kooperation 

Das Zusammenwirken der Komponenten Gruppenbildung, Situationsbewertung 
und Bewegungsplanung wird in diesem Abschnitt anhand dreier Beispiele de- 
monstriert. Dabei wird außerdem die iterierte Planung und Ausführung mit ver- 
schiedenen Bcwcgungsplancrn gezeigt. 

Als erstes Beispiel wird eine Variante des Szenarios Hindernis 2 betrachtet. Ins- 
gesamt sieben Fahrzeuge befinden sich auf zwei baulich getrennten Fahrbahnen. 
Zur kooperativen Bewegungsplanung wird die Methode der elastischen Bänder mit 
einem Planungshorizont von th = 2.4 s eingesetzt. Die Ergebnisse sind in den Ab- 



bildungen|6.2y und 6.3()|darücstellt. Zunächst werden die Einzelfahrzcuue vom Si- 



mulator gesteuert. Die Fahrzeuge bilden zwei kooperative Gruppen: Qi besteht aus 
den drei ostwärts fahrenden Fahrzeugen (blau dargestellt), Q-) aus den vier Fahr- 
zeugen auf der baulich getrennten Gegenfahrbahn (rot). Für die Gruppe Qi wird 
eine Gefahrcnsituarion erkannt, sodass zum Zeitpunkt t = 2.65 .s ein automatischer 
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(a) Fahrzeugpositionen und Gruppeneinteilung zum Zeitpunkt /— 3.2 s 




(b) kooperativer Bewegungsplan zum Zeitpunkt / — 3.2 s 



1 

(c) Fahrzeugpositionen und Gruppeneinteilung zum Zeitpunkt i ^ 3.7 s 



(d) Fahrzeugpositionen und Gruppeneinteilung zum Zeitpunkt ^ = 1.6 s 

.Abbildung 6.30: Simulation des Gesamtsystems im Szenario Hindernis 2 (Fort- 
setzung). 



Eingriff beginnt. Der zugehörige kooperative Bewegungsplan ist in [Abb. 6.29(b) 
dargestellt. Da die Fahrzeuge aus Q'i nicht berücksichtigt werden müssen, ist eine 
effiziente Planung möglich. Abbildung ö.I'jCc) zeigt eine Vi.sualisierung der To- 



leranz Ei k (.'^.S4 zum Zeitpunkt / 3.0.') s im Bcwcgungsplan aus Abb. 6.29ib) 



Der Koordinator kommuniziert den kooperativen Bewegungsplan zusammen mit 
den berechneten Toleranzvorgaben an die Fahrzeuge der kooperativen Gruppe . 
Die Einzelfahrzeuge könnten nun eine Feinplanung innerhalb ihres Toleranzspiel- 
raums vornehmen. Dieser Schritt wird hier allcrdinus nicht simuliert. Stattdessen 
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(a) Fahr/.cugpositionen und Gruppcncinteilung /.um Zeitpunkt t— 3.5 s 
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fb) kooperativer Bewegungsplan zum Zeitpunkt / — 3.5 s 




(c) Fahrzeugpositionen und Gruppeneinteilung zum Zeilpunkt t = 4.7 s 
Abbildung 6.31: Simulation des Gesamtsystems im Szenario I fberholen I. 

beginnen die Fahrzeuge direkt mit der Ausführung des geplanten kooperativen 
Manövers. 

Wahrend die Gefahrensiluation weiterbesteht, wird zweimal eine ilerierle Neu- 



planung durchgeführt. Abbildung 6..30(b) zeigt den kooperativen Bewegungsplan 



nach der ersten Iteration. Nachdem die Gefahrensiluation erfolgreich bewältigt ist, 
wird die Kontrolle der Einzelfahrzeuge zum Zeitpunkt / = 4.6 .s wieder an den Si- 
mulator übertragen. 

Die beiden folgenden Beispiele werden etwas weniger ausführlich dargestellt. 
Im Szenario Überholen I tritt das entgegenkommende Fahrzeug zum Zeitpunkt 
t=0.7 s der kooperativen Gruppe der drei ostwärts fahrenden Fahrzeuge bei. Die 
Situationsbewertung erkennt, dass zum Zeitpunkt f ~ 3.5 s ein automatischer Ein- 
griff zur Kollisionsvermeidung erforderlich ist ( Abb. 6.3 1 (a)| >. Es wird ein koope- 



rativer Bewegungsplan ausgeführt, der vom Baumsuchalgorithmus mit T — 3 Ent- 
scheidungszeiipunkien und einem Planungshorizont von — --4 erstellt wurde 
( Abb. 6.3 l(b)| . Nach einer weiteren IManungsiieralion ist die Gefahrensiluation 



zum Zeitpunkt t = 4.7 s erfolgreich bewältigt ( Abb. 6.3 l(c)^ 



Das dritte Beispiel ist ein Kreuzungsszenario mit insgesamt 1() Fahrzeugen, die 
zu Beginn 5 kooperative Gruppen bilden ( Abb. 6.32(a)| . Zum Zeitpunkt f = 0.3s 



muss ein kooperativer Eingriff erfolgen, weil das von Norden kommende Fahrzeug 
die Vorfahrt an der Kreuzung missachtel. Mit dem Baumsuchalgorilhmus wird ein 
kooperativer Bewegungsplan erstellt, der die Gefahrensituation durch Geschwin- 
digkeitsanpassung abwendet ( Abb. 6.32(b)| . Der automatische Eingriff endet zum 



Zeitpunkt t = 1.5 .s ( Abb. 6.33| . Kurz danach löst sich die betroffene kooperative 
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6 Ergehnisse 
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(a) Fahrzeugpositionen und Gruppeneinteilung zum Zeitpunkt f — 0.3 s 
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(b) kooperativer Bewegungsplan zum Zeitpunkt t = 0.3 s 
Abbildung 6.32: Simulation des Gesamtsystems in einem Kreuzungsszenario. 



6. 7 Zusammenfassung 
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Abbildung 6.33: Simulation des GesLimtsystems in einem Kreuzungsszenario 
(horlselzung): Fahrzeugposilionen und druppeneinleilung zum Zeitpunkt t = 
1.5 s. 



Gruppe auf, da die Fahrzeuge die Kreuzung in unterschiedliche Richtungen ver- 
lassen. 



6.7 Zusammenfassung 

In diesem Kapitel wurde das Konzept zur Kooperation kognitiver Automobile in 
Gct'ahrcnsituationcn mit Hilfe eines Verkehrssimulators evaluiert. Es wurde ge- 
zeigt, dass die verteilte Bildung kooperativer Gruppen in Echtzeit und robust ge- 
genüber Kommunikationsstörungen möglich ist. Mit den vorgeschlagenen Grup- 
penbildungskriterien wird erreicht, dass die an einem Unfall beteiligten Fahrzeuge 
überwiegend in dieselbe Gruppe eingeteilt werden. 
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6 Ergebnisse 



Beim Vei^leich der Algorithmen zur kooperativen Bewegungsplanung wurde 
nachgewiesen, dass eine Planung im Raum der kooperativen Handlungsaltemati- 
ven in manchen Szenarien deutlich mehr Probleminstanzen erfolgreich lösen kann 
als das Standardverfahren der prioritätsbasierten Planung. Gleichzeitig zeigen der 
Baumsuchalgorithmus und die Methode der elastischen Bänder Potenzial für einen 
echtzei (fähigen Einsatz in Szenarien mit bis zu vier kooperativen Fahrzeugen. Die 
Flexibilität der Algorithmen erlaubt verschiedene Varianten und Erweiterungen 
wie die Minimierung der Kollisionsschwere. 

Schliefilich wurde die Integration der Komponenten Gruppenbildung, Situations- 
bewertung, Bewegungsplanung und Verhaltensausfuhrung zum Gesamtsystem der 
verteilten Kooperation demonstriert und somit das Potenzial kooperativer Fahr- 
manöver zur Erhöhung der Verkehrssicherheit aufgezeigt. Für eine abschließende 
Bewertung des Ansatzes sind jedoch Unfallanalysen und Fahrversuche mit realen 
Erprobungsfahrzeugen erforderlich, die zukünftigen Arbeiten vorbehalten bleiben 
müssen. 



Oüpy iiyhico inaiotial 
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Kapitel 7 



Zusammenfassung und Ausblick 

In dieser Arbeit wurde anhand zahlreicher Beispiele das Potenzial der Kooperation 
kognitiver Auttimohile zur nrhöhung der Verkehrssiclierheit aufgezeigt. Die Wei- 
terentwicklung der vorgeschlagenen Verfahren, die konkrete Ausgestaltung eines 
Assistenzsystems zur kooperativen KoUisionsvermeidung, Tests mit realen Erpro- 
bungsfahrzeugen und eine systematische Nutzenbewotung bleiben zukünftigen 
Arbeiten vorbehalten. 



7«1 Zusammenfassung der Beiträge und Ergebnisse 

In dieser Arbeit wurde ein Ansatz zur Kooperation kognitiver Automobile unter- 
sucht, der die Bewältigung von (ietahrensituationeii durch automatische koope- 
rative 1 ahrmanövcr zum Ziel iiat. Die kognitiven Automobile organisieren sich 
in kooperativen Gruppen, in denen die weitere Verarbeitung und Entscheidungs- 
findung abläuft Durch die Begrenzung der Gruppengröße kann der Rechen- und 
Kommunikationsaufwand in akzeptablem Rahmen gehalten werden. Simulations- 
ergebnisse legen nahe, dass viele Gefahrensituationen inn^halb einer kooperati- 
ven Gruppe auftreten und daher mit dem vorgeschlagenen Konzept entschärft wer- 
den können. Um dies zu erreichen, wurde eine Bewertungsfunktion für kooperative 
Gruppen definiert, die speziell die Anforderungen eines kooperativen Sicherheits- 
systems abbildet. Grundlage für die Bewertungsfunktion ist ein Abstandsbegrifif 
für Fahrzeuge im Straßennetz, der sowohl räumliche als auch zeitliche Aspekte 
berücksichtigt. Die Sitnulation des vorgeschlagenen Verhandlungsprotokolls zeigt, 
dass eine verteilte Gruppenbiidung auch bei unzuverlässiger Kommunikation ro- 
bust durchgeführt werden kann. 

In Gefahrensituationen wird basierend auf der im gemeinsamen Lagebild verfüg- 
baren Infonnation eine Entscheidung über kooperative Fahrmanöver zur KoUisi- 
onsvermeidung getroffen. Hierzu werden Bewegungsplanungsalgorithmen einge- 
setzt, die eine möglichst aUgemeüigültige Behandlung verschiedener Situationen 
und Umgebungsbedingungen ermöglichen. Eine wichtige Entwurfsentscheidung 
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7 Zusammenfassung und Ausblick 



bei der Bewegungsplanung für mehrere Fahrzeuge ist die Frage, ob Entkopplungs- 
annahmen verwendet werden. Durch die Entkopplung in mehrere Teilprobleme 
wird die Rechenkomplexität erheblich reduziert, gleichzeitig aber auch die Menge 
der crziclbarcn Lösungen eingeschränkt. In dieser Arbeit wurden drei Algorith- 
men vorgeschlagen, die auf Entkopplungsannahmen verzichten und dadurch eine 
größere Anzahl an Kombinationen von Einzelfahrzeughandlungen zu kooperativen 
Handlungen zulassen. Die Algorithmen sind speziell auf das Problem der koopera- 
tiven Kollisionsvermeidung zugeschnitten und berücksichtigen die verschiedenen 
Anforderungen, die sich beispielsweise aus der Fahrzeugdynamik und dem Stra- 
ßenverlauf ergeben. Die Struktur des Problems wird zur Effizienzsteigerung ge- 
nutzt, etwa indem auf Grundlage von Einzelfahrzeughandkmgen Schranken vor- 
berechnet werden. Die Flexibilität der Algorithmen erlaubt die Verwendung von 
alternativen und erweiterten Zielvorgaben wie beispielsweise der Minimierung der 
Kollisionsschwere. Simulationsergebnisse zeigen einerseits, dass die Planung ko- 
operativer Fahrmanöver für bis zu vier beteiligte Fahrzeuge mit einer Rechenzeit 
in der Größenordnung von einer Sekunde möglich ist. Mit schnelleren Prozesso- 
ren, einer optimierten Implementierung und einer Parallelisierung der Algorithmen 
sollte sich der Rechenaufwand auf wenige Zehntelsekunden reduzieren lassen, so- 
dass die Echtzeitforderungen der Anwendung erfüllt werden können. Andererseits 
ist zu beobachten, dass die vorgeschlagenen Algorithmen zur kooperativen Bewe- 
gungsplanung in zahlreichen Szenarien eine größere Erfolgsrate hinsichtlich der 
Kollisionsvermeidung haben als ein Entkopplungsverfahren wie die prioritätsba- 
sierte Planung. 



7.2 Ausblick 



Die Ergebnisse aus Kapitel 6.4 zeigen, dass die Leistungsfähigkeit der Bewegungs- 
planungsalgorithmen mit dem betrachteten Szenario variiert. Als Konsequenz dar- 
aus könnten Ansätze zur Kombination mehrerer Algorithmen sinnvoll sein. Eine 
Möglichkeit ist eine regelbasierte Auswahl und Parameirierung eines geeigneten 
Algorithmus in Abhängigkeit von Kriterien wie Anzahl der Fahrzeuge, Anfangs- 
geschwindigkeiten, Art und Verlauf der Straße (vgl. IBuckOll ). Eine Alternative 
ist die simultane Ausführung mehrerer unterschiedlich parametrierter Bewegungs- 
plancr, um an.schließcnd das beste Ergebnis verwenden zu können (CarpinO^ . 
Indem auf jedem beteiligten Fahrzeug ein anderer Algorithmus ausgeführt wird, 
lassen sich zudem die Rechenkapazitäten mehrerer Fahrzeuge für die Bewegungs- 
planung nutzen IClark03l . Eine weitere Möglichkeit ist die Kombination der hier 
untersuchten kooperativen Bewegungsplanungsalgorithmen mit dem Prinzip der 
Priorisierung, um ein effizientes Verfahren für eine größere Anzahl von Fahrzeu- 



7.2 Ausblick 
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gen zu erhalten: Eine kooperative Bewegungsplanung im Sinne von Kapitel 5 wird 
nur für die Fahrzeuge durchgeführt, die sich gemäß den Kriterien aus Kapitel 3.5 
in einer besonders kritischen Situation befinden. Die weiteren Fahrzeuge erhalten 
eine niedrigere Priorität zugewiesen und berücksichtigen die geplanten Manöver 
als bewegte Hindernisse. 

Eine größere Herausforderung ergibt sich aus Unsicherheiten in den Eingangs- 
daten, die in den Wahrnchmungs- und Intcrprctationsschrittcn unvermeidlich auf- 



treten. In |AhschniLl 23.2 wurden zwar einige Bahnplanungsalgorithmen erwähnt. 



die unsichere Information berücksichtigen können, dem Verfasser ist aber kein 
Verfahren bekannt, das eine echtzeitfähige Bewegungsplanung unter Unsicher- 
heit für mehrere Straßenfahrzeuge ermöglicht. Die Einbeziehung von Positions- 
unsicherheiten durch zusätzliche Sicherheitsreserven ist bei den in dieser Arbeit 
betrachteten Algoriüimen problemlos möglich: Ähnlich wie in 



Abschnitt t).5.2 



können Fahrzeug- und Hindernismodelle in Abhängigkeit von der Standardabwei- 
chung der Positionsdaten vergrößert werden. Diese stark vereinfachte Vorgehens- 
weise entspricht jedoch nicht der entscheidungstheoretischen Optimierung aus |Ab-| 
schnitt 5.37T| Ein interessanter Ansatz zur Entscheidungsfindung unter Unsicher- 



heit sind Bayes'sche Entscheidungsnetzwerke, die eine Kopplung von Situations- 
erkennung und Verhaltensenischeidung ermöglichen |Forbes9.5| . Ob solche Me- 
thoden für die betrachtete Anwendung die geforderte Effizienz erreichen können, 
erscheint allerdings fraglich. Daher könnte eine hierarchische Verhaltensentschei- 
dung sinnvoll sein, in der probabilistische Verfahren auf höherem Abstraktions- 
niveau eingesetzt werden, während die Feinplanung unter Berücksichtigung der 
physikalischen Randbedingungen mit Hilfe der hier betrachteten Bewegungspla- 
nungsalgorithmen vorgenommen wird. 

Auf dem Weg zum Einsatz der kooperativen Kollisionsvermeidung im rea- 
len Straßenverkehr sind noch zahlreiche weitere Fragestellungen zu adressie- 
ren, die in dieser Arbeit bewusst ausgeklammert wurden. Hierzu gehören die 
Mensch-Maschine-Interaktion, das Zusammenwirken mit der Fahrzeug-Fahrzeug- 
Kommunikation sowie gesellschaftliche und rechtliche Rahmenbedingungen (sie- 
he {ÄFscHnuTTI]!. Eine Bewertung des Syslemnutzens basierend auf realen Un- 



falldaten steht ebenfalls noch aus, zu dieser Thematik siehe IBuschQ51lvArem06l 
KillatÜ81 IHannavvaldOSI . Schließlich ist eine Erprobung mit realen Fahrzeugen 



erforderlich. Dabei stellt sich das Problem, wie das Verhalten in Gefahrensi- 
tuationen ohne zu großes Risiko für die Testfahrer untersucht werden kann. 
Für die Erprobung von Assistenzsystemen auf Einzelfahrzeugebene werden un- 
ter anderem Hindernisattrappen und Hardware-in-the-Loop-Methoden eingesetzt 
IFecherü8HChristen04i . Für kooperative Systeme bestünde eine Möglichkeit dar- 



in, zunächst nur ein reales Fahrzeug zu verwenden und die anderen beteiligten 
Fahrzeuge im Rechner zu simulieren. 
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7 Zusammen fassitng und Aushlirk 



Weitere Erkenntnisse zur Realisierbarkeit kooperativer Systeme können mög- 
licherweise der laufende 1^'eldversuch zur I-ahrzeugkomnuinikalion SIM-TD 
[ Stil hing iT)) sowie die Cirand Cooperative Driving Challenge beitragen, in der ko- 
operatives Fahren zur Vcrkehrsflussoptimicrung demonstriert wurde IGC HC III . 



Interessant könnte ferner die Erweiterung des Konzepts aus Kapitel 3 auf zusätz- 



liche Anwenduneen sein. Zu untersuchen wäre die Fraue, inwieweit z. B. die Kri- 
tcrien für die Gruppcnbildung angepasst werden müssen, um etwa eine Vcrkchrs- 



flussoptimierung an Kreuzungen zu integrieren (siehe Abschnitt 2.2.31. Neben der 
verteilten Verkehrssteuerung an Kreuzungen besteht eine weitere Anwendungs- 
möglichkeit der kooperativen Bewegungsplanung in der Koordination des Ver- 
kehrs mit bevorrechtiiiten Einsatz- und Rettunusfahrzeuszen. 
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Anhang A 



Algorithmen 

In diesem Anhang werden einige der in den Kapiteln [4] und [5] vorgeschlagenen 
Algorithmen im Pseudocode wiedergegeben. Außerdem werden einige Analyse- 
und Implementierungsgesichtspunkte behandelt. 



A.l Abstandsberechnung für die Gruppenbildung 



Der Pseudocode des Verfahrens zur Abstandsberechnung aus Kapitel 4. 



ist m 



Algorithmus 1 wiedergegeben. Im Folgenden wird dieser Algorithmus im Hinblick 
auf Korrektheit und Rechenaufwand analysiert. 



Satz A.l Algorithmus 1 terminiert und berechnet das Abstandsmaß aus Definiti- 
bn4.1l 



Beweis: Da K keine negativen Kantengewichte hat, kann die Terminierung und 
die korrekte Berechnung von pjiici. v) :^ P7?("7?(<"r),^') ebenso wie beim Algo- 
rithmus von Dijkstra bewiesen werden |(\H-nicii() 1 1 Kapitel 24.31. Zu zeigen ist 
noch, dass der Algorithmus in Zeile 13 mit dem nächslmöglichen Treffpunkt t'n, 
terminiert, dass also die Minimierung aus ( |4.2| > korrekt durchgeführt wird. 

Sei hierzu v der Knoten, mit dem der Algorithmus in Zeile 13 termi- 
niert, und t'm der Knoten, der ( j4.2^ minimiert. Zum Widerspruchsbeweis 
wird angenommen, dass der berechnete Abstand nicht minimal ist, also dass 
max{/>7j(Q, tOi/>TC(c2,i')} > max{/>R(ci, r„,),/>TC(c2, i'ni)}. Es folgt pTz{ci,v) > 
max{/;K(ci, Um),/>7e(c2, t'm)} für ein i G {1,2}. Für w aus Zeile 10 hat man 
somit uf = Eigen.schaften der Prioritätswarteschlange und 

des Algorithmus von Dijkstra folgt, dass Vj^ bereits vor v von beiden Such- 
fronten erreicht wurde. Somit hätte der Algorithmus bereits beim Knoten 
terminieren müssen. Dieser Widerspruch zeigt max{/>R(ci, f),/>re(c2, i')} < 
max{pK(ri, »'m): />rc(<'2r*-m)} = dR{ci,C2). Wegen der minimalen Wahl von Vm 
in ( |4.2| folgt die Gleichheit max{/j7e(ri, r),pTC(f2, r)} = äji{ci,C2). 
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A Algorithmen 



Algorithmus 1 Berechnung des Abslandsniaßes f//? (ci . co) 
I: procedure ComputeDistanceiT^. ci, co) 



2: lNSERT(/ife:ajy. (ci, Ü7e(ci)), ü) 

3: lNS]iRT{heap, (c2, i't? (fo)), Ü) 

4; for all vcrticcs v of TZ do > Initialisierung 

3: for c= ci , C2 do 

6: pTiic.v) ^OO 

7: end for 

8: cnd for 

9: repeat 

10: {{c,v),w) ^ REMOVEMlNIMUM(/jeap) > w minimal in heap 

11: pTi{c,v) ^ w 

12: if />72(ci , v) < oc A /^/^(co, < 00 thcn > Treffpunkt gefunden 

13: return nmx{pjz{ci, v),pn{c2, v)} 

14: end if 

15: for all edges e = (v, u') of 7^ do t> Nachfolger von v abarbeiten 

16: if (c, i/) = oc thcn 

17: \SSERj{heap, (c, v'), w + 

18: eise if />;^(c, r') > I tr(e) theo 

19: DECREASEKEY(/?ea/;, (c, v'), tu + ii'(e)) 

20: end if 

21: end for 

22: until IsEMPTY(//ta;^) V tu > rf,hr 

23: return -x; > im Suchradius (/,hr ist kein Treffpunkt erreichbar 



24: end procedure 



Vorausgesetzt wurde hier, dass ein Treffpunkt existiert. Da ein Treffpunkt einem 
von beiden Fahrzeugpositionen aus erreichbarem Knoten entspricht, kann dies für 
ein korrekt repräsentiertes Straßennetz angenommen werden. Andernfalls wäre 
das Straßennelz nicht zusammenhängend. Der nächstmögliche Treffpunkt muss 
nicht eindeutig bestimmt sein, d.h. es kann mehrere Knoten geben, für die das 
Minimum in ( |4.2[ i angenommen wird. □ 

Satz A.2 Die Berechnung des Abstandsmaßes djz für N Fahrzeuge ist in einem 
Siraßengraphen 7^ mit V Knoten in einer Rechenzeit von 0{N~ -V- lüg(l^)) 
möglich. 



Beweis: Algorithmus 1 besucht jede Kante und jeden Knoten von TZ höchs- 
tens zweimal, nämlich je einmal für jede der beiden Dijkstra-Suchfronten. Die 
dabei ausgeführten Operationen INSERT, DECREASEKEY und REMOVEMini- 



A. I Abstandshererhniin^ für die Gmppenbihhing 



MUM der Prioritätswarteschlange (lifap) haben einen logariihniischen Zeitauf- 
wand ICorinen0 1 1 Kapitel 6]. Somit erhalt man bei V Knoten und E Kan- 
ten einen Aufwand von 0{V + E- logE) für die Berechnung eines Abstands- 
werts dR{ci,C2). Für den Graphen R kann aufgrund seiner Konstruktion aus der 
StrafSenbeschreibung ein beschränkter Verzweigungsgrad angenommen werden: 
E < K ■ V für eine Konstante A' , die von V unabhängig ist. Somit ergibt sich ein 
Aufwand von 0{V ■ log V''). 

Der Zeilaufwand zur Auswertung der Funktion Vj^ in den Zeilen 2 und 3 ist ver- 
nachlässigbar: Eine naive Implementierung benötigt 0{V). Geeignete hierarchi- 
sche Suchstrukiuren und inkremenielle Verfahren können diesen Schritt noch er- 
heblich beschleunisen. 



Durch Ausfiihrunü von 



Aluorithmu^ 



s 



für alle — — — Paare von Fahrzeugen 



ergibt sich ein Zeitaufwand von C^(A' - • V • lug V). □ 



Die Abstandsberechnunc kann auch für alle Paare der .V Fahrzeuee in einem 



Durchlauf erfolgen, indem in Verallgemeinerung \ov\ Algorithmus 1 für alle 
Fahrzcuiie simultan eine Kürzcstc-Wcwc-Suchc ausccführt wird. Dadurch werden 
i.d.R. viele redundante Berechnungen vermieden, allerdings verbessert sich der 
asymptotische Zeitaufwand für den schlimmsten Fall nicht. 

Navigationskarten umfassen häuhg ein sehr großes Gebiet, etwa ein ganzes Land 
oder ganz Europa. Wenn der Graph 7v aus einer solchen Karte erzeugt wird, ist die 
Knotenanzahl V sehr groß und ein Durchsuchen des gesamten Graphen mit einem 
Zeitaufwand von 0{V ■ logV) kann nicht mehr toleriert werden. Dies ist aber 
auch nicht erforderlich, da die Suche in Zeile 13 des Algorithmus abucbrochen 
wird, sobald der nächste Treffpunkt berechnet wurde. Hierfür muss lediglich ein 
Gebiet von der Ausdehnung des Abstands f/fj(ci,C2) und somit eine wesentlich 
geringere Anzahl von Knoten betrachtet werden. Es ist auch möglich, die Suche 
abzubrechen, sobald der aktuelle Suchabstand iv aus Zeile 10 einen Schwell wert 
J,hr überschreitet. Dieser Schwellwert sollte so gewählt werden, dass bei einem 
größeren Absland keine sinnvolle Kooperation möglich ist und die Fahrzeuge so- 
mit verschiedenen (Jruppen zugeordnet werden sollten. 

Alternativ kann auch zuerst ein Teilgraph des Straßennetzes ausgewählt werden, 
auf den sich die Abstand.sberechnung beschränkt. Dieses Vorgehen ist ähnlich zu 



dem in nRess05l beschriebenen elektronischen Horizont. In dem Teilgraphen exis- 
tiert unter Umständen kein gemeinsamer Treffpunkt der beiden Fahrzeuge, d. h. es 
gibt keinen Knoten, zu dem sowohl von ^^(ri) als auch von ^^1(02) ein gerichteter 



Weg existiert. In diesem Fall liefert Algorithmus I als Ergebnis oc (Zeile 23). 
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Ä Algorithmen 



A.2 Partitionierung in kooperative Gruppen 



Algorithmus 2 zeigt den Pseudocode des Any-Time-Verfahrens aus Ab- 



schnitt 4.4.3 zur approximativen Berechnung der optimalen Partition P* einer 



Fahrzeugmenge C in kooperative Giiippen gemäß Gleichung (479). Im Unter- 



schied zum gierigen Algorithmus wird jede evaluierte Vereinigung zweier Grup- 
pen zur späteren Weiterverarbeitung in eine Prioritätswarteschlange Oieap) ein- 
gefügt. Da dieselbe Partition durch unterschiedliche Abfolgen von Vereinigungs- 
schritten erreicht werden kann, wird eine do6e(/-Liste zur Vermeidung mehrfacher 
Auswertungen eingesetzt. 

Algorithmus 2 Any-Time-Algorithmus zur approximativen Berechnung der 
Gruppeneinteilung 

1: prucedure Computf.PartitionCC = {ci, . . . , cn}) 

2: Po { {('i } 1 {f'iV } } t> Initialisierung mit 1 -Fahrzeug-Gruppen 

3: I N SH RT( //eap, Fo , «( F, i ) ) 

4: F' - Fo 

5i while timc Icft do 

6: (^1*') ^ RnMOVnMlNFMUM(/?r(77?) t> P minimal in Jirnp 

7: for all Qi e F do [> Vereinigung zweier Gruppen untersuchen 

8: for all G, e P, Gj / Gi do 

9: P' ^ F\{G,.GJ]y^{G■,^JGJ] 

10: if P' ^ r/o.srY/then > Partition bereits überprüft? 

1 1 : s{P') ^ s{F) - s{G,) - .'^{Gj) + s{G, u Gj) 

12: lNSnRT(/jeap, P', .s(P')) 

13: lNSERT(c7osef/, P') 

14: if «(P') < .s(P*} then > bessere Partition gefunden 

15: P* ^ P' 

16: end if 

17 endif 
18: cnd for 

19: cnd for 

20: cnd whilc 

2 1 : return P* 
22: end proccdure 



A.3 Baumsitrhalgoritlunus zur Beweg ungsplanun^ 
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A.3 Baumsuchalgorithmus zur Bewegungsplanung 



A.3.1 Dateiistruktur 



Dieser Abschnilt behandelt die Implementierung der Datenstrukturen Bi und Bij 
für die Zwischenspeicherung und Vorberechnung von ninzelfahrzeug- und Zwei- 
Fahrzeug-lnformaiion (vgl. Kapitel 53) . Wegen des festen Verzweigungsgrads 
Ai bzw. Aj • Aj ist die Speicherung der Baumstrukturen in einem Array mög- 
lich, ähnlich wie dies bei binären Heaps üblich ist |Vlehlhorn08l Kapitel 6.1]. Ein 
Vorteil dieser Vorgehensweise ist die effiziente Speicherverwaltung: Der Speicher 
kann als ein großer Block reserviert werden, sodass während der Konstruktion des 
Baums keine weiteren Speicherreservierungen für die einzelnen Knoten durchge- 
führt werden müssen. Die Funktionen ch{n,a), pa{n), /?,(n) und nij{n) können 
über Operationen mit den Array-Indizes realisiert werden, sodass der Speicher- 
platz für Zeiger auf Kinder und Eltern eingespart werden kann. 

Die Knoten /?, von Bi und von Bi_j können mit ihren Array-Indizes indenti- 
fiziert werden, da jeder Indexwert genau einem Knoten entspricht. Die Speicher- 
adressen ergeben sich durch die Multiplikation der Indizes mit der Blockgröße, die 
erforderlich ist, um alle Daten eines Knotens vom jeweiligen Typ zu speichern. Für 
die Knoten iii von Bj sind dies der Fahrzeugzustand X/(/j/), der Verlustfunktions- 
wert L;^ (/?,) und die untere Schranke In einem Knoten n,-,j von 5,,^ wird 
die Kollisionsbewerlung Lf^jiiii j) und die untere Schranke hi j{ni j) gespeichert. 

Die Handlungen «, € Ai werden von 1 bis .4, nummeriert. Dann können die Funk- 
tionen cJi, pa und a für die Bj und B^^ auf der Grundlage der Indizes wie folgt 
formuliert werden: 



WOti 

chi{ni,ai) 
paiirii) 
fiiini) 



= 0 



Ai ■ II, I üi 

n, - 1 
A, 

n, - Ai ■ P",{iii) 



(A.la) 
(A.Ib) 

(A.Ic) 

(A.ld) 



rootij = 0 

Chijimj, {üi, Üj)'^) - Ai ■ Aj ■ 7lij -\- Aj ■ {üi - l) -\- üj 

rii.j - 1 



Ai • Aj 



(A.2a) 
(A.2b) 

(A.2c) 
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Der Baum ß der kooperativen Mandlungssequenzen wird nicht in dieser Form ge- 
speichert, da der Arbeitsspeicher hierfür im Allgemeinen nicht ausreicht. Vielmehr 
wird während der Suche nur eine Teilmenge der Knoten im Speicher gehalten. Ein 
Knoten /} von B ist durch den Vektor («i, . . . , tim)^ der korrespondierenden In- 
dizes in den Einzelfahrzeugbäumen eindeutig charakterisiert, da sich aus jedem 
index Tii die ausgewählte Handlungssequenz von Fahrzeug c, rekonstruieren lässt. 
Damit ist auch die kooperative Handlungssequenz festgelegt, die den Weg von der 
Wurzel ivot zu n bestimmt. Wird ein Knoten /< mit seinem Indexvektor identifi- 
ziert, können ch{n,a) und pa{n) für ß auf die bereits für ßi definierten Funktio- 
nen chi{nj) und pa^(n,) zurückgeführt werden: 

root = (0. . . . , 0)'^ 
c/j(n,a) = ch{{ni, "a/)'^, (fli, . . . , a.w)'^) 

= {chi (ni , ai ) f/i j\/ (/'A/ , «A/ ))^ 

pa{n) = po.((ni, . . . , «a/)'^) = {pa^ini), . • . , po.A/("A/))^ 

Die Abbildung ni{7i) von n € ß nach ßi reduziert sich dann auf die Projektion 
des Indexvektors auf seine i-te Komponente: 

n/(n) = n,:((r?i, . . . , n,- n\f)'^) = th (A.4) 

Für die Implementierung der Abbildung nij{n) auf Bjj werden zwei 
Möglichkeiten genannt: Entweder wird der ''^^ -elementige Vektor 

(^'i.2i ^'1,3: • • • : '^'A/-i,A/)^ der Indizes in den ß,.y, 1 < i <j < M, zu jedem n 
mitgeführt und mit Hilfe der Funktionen chj j, pa^ j modifiziert, oder die Handlun- 
gen werden aus den Einzelfahrzeugindizes rekonstruiert und daraus werden mittels 
iterierter Anwendung der chij die Indizes der rii j berechnet. 



(A.3a) 
(A.3b) 
(A.3c) 



A.3.2 Vorberechnung von unteren Schranken 



Algorithmus 3| führt die Vorberechnung der unteren Schranken hj{ni) in den Ein- 



zelfahrzeugbäumen ßj durch. |Alg(Mithmus 4 berechnet die unteren Schranken 



hij{nij) für die Kollisionsbewertung in den Zwei-Fahrzeug-Bäumen ßij (sie- 
he dazu [Abschnitt 5.3.5) . Die Bäume werden rekursiv bis zu einer Tiefe von Fsv 
bzw. Fgoii aufgebaut. Beim rekursiven Abstieg wird die Verlustfunktion für alle 
Handlungsalternativen ausgewertet. Nach der Abarbeitung aller Kindknoten erhält 
man durch Minimumbildung die gesuchten unteren Schranken. 
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Algorithmus 3 Vorberechnung von unteren Schranken in den Einzell'ahrzeugbau- 

men 

1: procedure PrecomputeTreeU/, tu) 

2: h* OO 

3: for all a, e A, do 



4: 
5 

6 
7 
8 

9 

10 
11 
12 
13 
14 
15 
16 
17 
18 
19 
20 
21 
22 
23 
24 
25 



if < Psv thcn 

/}. ^ PrecomputeTreeI (/, «i) > Rekursion 

eise 

h^O > Basisfall 

hiin'i) ^ 0 
eiid if 

h* ^ min {/»*,/». + L} > (5ÄQ\ 

end for 
/f,(n,) ^ /i* 
return /<* 
end procedure 

procedure PrecomputeBoundsSV(x'"''*) 
for 2 = 1, . . . , M do 

RESERVEMEMORYSV(i, Ss\ ) 
xirooti) ^ xf " 
k{rooti) ^ 0 

PrecomputeTree1(<, woti) 
end for 
end procedure 
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Algorithmus 4 Vorbcrcchnung von iinicrcn Schranken in den Zwei-Fahrzeug- 
Bäumen 



1: procedure PrecomputeTree2(/, j, uij) 

2: h* f— oo 

3: for all o, G A, do 

4: for all aj € Aj do 

6: L*- Lf;f{xi{ni{jHj)).Xj{tij{7iij)),{ai,ajf 

7: if A-(;7;. ^) < Peoii then 

8: h ^ PreCOMPUTETree2(/, j, n'- j) > Rekursion 

9: cLsc 

10: h^O > Basisfall 

12: end if 

13: ^ inin{/<*. h I L) > ^Ä2\ 

14: end for 

15: end for 

16: hijiUij) ^ ir 

17: return h* 
18: end procedure 

19: procedure PrecomputeCollBounds(x'""') 

20: for / = L M do 

21: for j = / + 1 M do 

22: RESERV EM EMORYCOLL ^coii) 

23: x{7V0t.ij} ^ ((xf')'^, {xf'^ff 

24: h{roofij) ^ 0 

25: PRnCOMPUTnTRnE2(/, j. rootij) 

26: end for 

27: end for 
28: end procedure 



A.3.3 Branch-and-Bound-Suche 



Die Branch-and-Bound-vStratcgic aus Abschnitt 5.3.6.1 



ist m 



Algorithmus 5] im 



Pseudocode dargestellt. Ausgehend von einem Knoten n werden für das folgende 
Zeitintervall [^A(n)? alle kooperativen Handlungen a€ .4 bewertet, indem 

der Verlustfunktionswert L und die untere Schranke h berechnet werden (Zeilen 3 
bis 7). Die generierten Knoten werden anschließend in aufsteigender Reihenfolge 
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ihrer Bewertung L-\-h abgearbeitet (Zeile 10). In Zeile 1 1 wird nach dem Kri- 
terium l )5.49{ ) entschieden, ob rekursiv in den Teilbaum abgestiegen wird oder ob 
der Teiibaum von der Suche ausgeschlossen werden kann. Die Varianten aus den 
Abschnitten 6.3.3 und 6.3.4 sind ebenfalls berücksichtigt. Das ursprüngliche Kri- 
terium ( )5.49| ergibt sich für ^subopt = 1 und Lthr = oo. 



( FR 



Algorithmii.s 5 Branch-and-Bound-Suche im Baum ß der kooperativen Hand- 
lungssequenzcn 

proccdurc SE-ARCllBBCn, L) 

for all a 6 v4 do 

"ch c/j(n,a) 

x(nch) — /(x(/0,a, /;t(„)+i-<fe(„)) 
L(nch) — L{K(ii).a,t^n)+i-h{n)) 

ACb ^AChU{ /;,h} 
end for 

for all //^h e Ach do in ascending ordcr of L{n^■\^) + /'("dj 
if -^suiH>pi • I ^(/'ch) f Huch)) < min{LMrh, } thcn 
if A-(nch) < T then 

Sr.ARrHBB(/;,h. + /:(r?ch)) 

eise 

n* ^ Uch 
cnd if 
end if 
end for 
end procedure 
procedure PLANBBix'""') 

PRnCOMPÜTEBOlJNDSSV(x'"'"') > 
PRr:COMPUTECOI.LBOLIND.S(x'''"^) l> 



[:• ( |5T49) 
Rckursion 



> bessere Lösung gefunden 



Algorithmus 3 



Aliiorithmus 4 



00 



pStart 



x(ro«/) *— X" 
SEARCHBB(7y?o/,0) 
return n* 
end procedure 



Copyri' ' ' ' ' rial 
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Ä Algorithmen 



A.3.4 A*-Suche 



Die A*-Siiche ist in Algorithmus 6 im Pseuclocode dargeslelll. Für die A*-Suciie 
wird der Baum in der Form B' aus [Abb. TJ konstruiert, sodass Jeder Knoten zu 
einer Entscheidung eines einzelnen Fahrzeugs korrespondiert. Die Nachfolger- 
knoten werden dann durch die Handlungen des nächsten Fahrzeugs ci^i erzeugt 
(Zeilen 14, 16), bis für jedes Fahrzeug zum jeweiligen Zeitpunkt eine Handlung 
ausgewählt wurde (Zeile 12). Die unteren vSchranken aus ( 5.44^ müssen schritt- 
weise über die Zwischenknoten berechnet werden (Zeilen 21, 22). Da für jeden 
zur Bearbeitung ausgewählten Knoten alle Kindknoten generiert werden müssen, 
wirkt sich der geringere Verzweigungsgrad von B' positiv auf die Leistungsfähig- 
keit der A'''-Strategie aus. 

In der Prioritätswarteschlang e (fn ap) werde n zu einem Knoten n sein Indexvektor 
{ni{n), . . . , nM{fi))^ (siehe Anhang A.3.1 , sein akkumulierter Verlustfunktions- 



wert L{root,n) und seine untere Schranke gespeichert. Im Fall A'(//) > 
muss zusätzlich der Zustandsvektor x(7?) gespeichert werden, der ansonsten in 
den ßi nachgeschlagen werden kann. Die PrioritätswiU"teschlange wird nach der 
Knotenbewertung (/(//) sortiert. Die Handlungssequenz zu der Lösung n aus Zei- 
le 9 kann mittels wiederholter Anwendung der (lleichungen l |A.ld| und ( jA. lc| > aus 
dem Indexvektor rekonstruiert werden. 
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Akoriihmus 3 



Algorithmus 4 



Algorithmus 6 A*-Suche im Baum 13 der kooperativen Handlungssequenzen 
1: procedure Plana *(x*""^) 

2: PRECOMPUTEBOUNDSSV(x''""') > 

3: PrecomputeCollBounds(x"''") c> 

4: root *— {rvoti, . . . , 70ot,\j)^ 

5: lNSERT(operi, {root, 0, h{root)), 0) 

6: repeat 

7: ((n, L, /j), .(/) ^ REMOVEMlNIMUM(ope?i) 

8: if A-(nA/(n)) = T then 

9: return n t> erstes besuchtes Blatt = optimale Handlungssequenz 

10: end if 

11: if k{ni (7i)) = k{n2 (n)) = . . . = then 

12: i <— 1 > nächster Zeitschritt k -\- 1 erreicht 

13: eise o nächstes Fahrzeug bestimmen 

14: i ^ miii{i € {2, . . . , .^/} | A'(ni_i(n)) > k{ni{n))} 

15: endif 

16: for all fli € -4, do 

17: Hch ^ (ni (n). . . . , n,:-i (;?,), chi{ni{n), Of), rii+i (n), . . . , nA/(n))'^ 

18: Xi(7lch) ^ fi{Xi{n), au t^n) | 1 " tk{n)) 

19: L(moi, rieh) ^ L + (n.(7?,h)) 

20: +E';U^;'K/("ch)) 

21: /H^ch) ^ /i + /?r(ni(nch)) - > nach ^5.44) 

22: + ("j,i("ch)) - 

23: <7("ch) ^ -^(roö«. n,.h) I ^subopt ■ /t(«ch) > g3Ö) 

24: if ö(nch) < ithr then 

25: TNSnRT(o;3fi/i, (/ich, L{root, /ich), ("ch)), f?("ch)) 

26: cnd if 

27: end for 

28: until lsEMPTY(o/)e/j) > nur für L,h, < oo möglich 

29: return failure \> keine kollisionsvermeidende Lösung gefunden 
30: end procedure 
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